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ABSTRACT 


Fast path-planning algorithms are needed for autonomous vehicles and tactical terrain-analysis 
tools. We explore a new approach using "optimal-path maps", that give the best path to a goal point 
from any given Start point in cross-country two-dimensional terrain for a moving agent of negli- 
gible size. Such maps allow fast point-location algorithms at run-time to categorize the start point 
according to the behavior of the optimal path to the goal, from which the path can be reconstructed. 
We study terrain modelled by piecewise-linear roads and rivers, polygonal obstacles, and by con- 
vex polygonal homogeneous-cost areas ("weighted regions"). We explore two methods for con- 
structing optimal-path maps, one based on wavefront-propagation point-to-point path planning, and 
a more exact divide-and-conquer algorithm that reasons about how optimal paths must behave. In 
the exact approach, boundaries caused by terrain features are characterized using analytical 


geometry and optimal-path principles, and partial optimal-path maps are merged into complete ones. 
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I. INTRODUCTION 


A. OVERVIEW OF PATH PLANNING 

Motion planning is an important problem in robotics, computational geometry, and many other applica- 
tions. A central part of motion planning, known as path or route planning, is the process of determining the 
path to be taken either by an agent's appendages or by the entire agent. The research reported herein is con- 
cerned with the latter of these two path-planning processes. Specifically, it is concerned with planning paths 
over long distances in cross-country terrain. Thus we are not concemed with small-scale motion, where robot 
appendages are moved among objects on a work-bench or robot legs are placed on the ground, for exainple, 
nor with medium-scale motion, where the agent's path must be planned so as to provide adequate clearance 
for itself, but with large-scale motion, where the size of the agent is negligible compared with the surround- 
ing terrain. 

Path planning will not typically be the only, or even the most important task which competes for comput- 
ing resources. For example, the purpose of an autonomous vehicle is to go somewhere independently and ac- 
complish a mission, a task which will require a large number of intermediate tasks which will each take 
computing time and space. Therefore it is important to find path-planning algorithms which use as few resour- 
ces as possible. This means increasing run-time speed and at the same time decreasing storage requirements. 
These are usually conflicting goals, but it is often possible to increase run-time performance or reduce storage 
at the expense of preprocessing time in a pre-mission phase when resources are not in demand. 

The problem of finding an optimal (least-cost) path between two points for a negligibly small agent over 
fixed, two-dimensional terrain with known cost characteristics can be attacked by several methods. When the 
agent is constrained to travelling on a finite number of known paths, the problem can be solved by network 
search algorithms, a subject of thorough study in operations research. When the agent is not constrained to 
travelling on specified paths, the area is called free space. Path planning in two-dimensional free space is 
beginning to be studied in depth by researchers in such fields as artificial intelligence, robotics, and computa- 
tional geometry. Most methods require homogeneous-cost background terrain interspersed with impassable 


obstacles, as for example for the Visibility-Graph algorithms [Ref. 1]. However, handling additional types of 


terrain features (for example, linear low-cost features, e.g., roads, linear fixed-crossing-cost features, e.g., 
rivers, [Ref. 2] and polygonal regions of homogeneous-cost terrain, e.g., forests, swamps, or fields, [Ref. 3]) 
will improve the ability to model terrain realistically. 

A promising approach to two-dimensional path-planning in free space which we develop in this research, 
called the optimal-path-map approach, provides greatly improved run-time speed at the expense of preprocess- 
ing time and storage. This approach partitions the plane during preprocessing into regions with similarly-be- 
haved optimal paths and then locates a start point in this partition at run time. Figure 1 shows an example 
optimal-path map with boundaries separating the regions of similarly-behaved optimal paths. Additionally, a 
set of vectors is superimposed on the optimal-path map in Figure 1 showing initial directions of selected op- 
timal paths. We develop the theoretical basis for such a partitioning for a more general set of terrain features 
than has previously been used in optimal-path-map construction, making this approach more practical for real- 
world cross-country path planning. Then once the optimal-path map is constructed, our approach can appeal 
to algorithms with worst-case time complexity of O(log n) to locate a start point in a planar partition (see Chap- 
ter Il, Section B), where n is the number of terrain-feature vertices. Once the start point is located in the par- 
tition, the behavior of the optimal path is identified and the path can be reconstructed. This response time is 
very attractive, especially for real-time systems like missiles or for systems with many competing computing 
requirements like autonomous vehicles. 

The principal results of our research are threefold. First, we adapted the wavefront propagation algorithm 
to find boundaries between regions of start points whose optimal paths are similarly behaved, and implemented 
three versions of the new algorithm. Second, we characterized boundaries mathematically by means of analytic 
geometry. Third, we proposed an algorithm to construct the planar partition using these mathematical results 


for convex polygonal and piecewise-linear terrain, as an alternative to our wavefront propagation algorithm. 


B. ASSUMPTIONS 

We assume that the terrain is known, and can be modelled by combinations of the five primitive types of 
terrain features presented below. We assume that terrain-feature edges can be modelled piecewise-linearly, 
that terrain is isotropic (traversal cost is independent of direction of travel), and that no two polygonal regions 


have common vertices. Although the mobile agent is constrained to travel in the two-dimensional plane of the 
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Figure 1 


Example Optimal-Path Map 


input map, assigned costs of travel may reflect that the actual surface being traversed varies in height. (See 
also Chapter II, Sections C and D.) 
Following Mitchell [Ref. 4], we make the a nea called the general-position assumption (Appendix 
A, Assumption I-3), that no terrain-feature vertex lies on a homogeneous-behavior boundary generated by 
another terrain feature, i.e., that there is not an accidental alignment of boundaries with terrain-feature ver- 
tices. This restriction does not change the following results significantly, but allows the discussion to proceed 
without convoluted, but unimportant, conventions. In an actual implementation of the algorithms proposed 
below, this assumption must be retracted. 
The following five terrain-feature types are allowed: 
e Background. Areas of the map which do not contain other terrain features have a fixed cost 
per distance travelled. 
e Obstacles. An obstacle is a convex poly gon enclosing impassable terrain. 


e Rivers. A river segment is a line segment whose cost to the agent to cross anywhere along its 
length is a fixed constant, not dependent on the angle of crossing. 


e Roads. A road segment is a line segment with a fixed cost per distance for length-wise traver- 
sal. Thus a road segment is infinitesimally thin, can be crossed at no cost to the agent, and can 
be entered or left anywhere along its length. 

e Convex Homogeneous-Cost Areas. A convex homogeneous-cost area (HCA) is a convex 
polygon with a constant positive cost per distance travelled. An HCA may have cost per dis- 
tance greater or less than the background terrain, but not zero. The agent may enter or leave the 
area at any point on its circumference at no additional cost. 

These terrain-feature types could all be modelled by HCAs. However, allowing obstacle, river, and road 
terrain features enhances efficiency by allowing us to take advantage of their simplicity. Specifically, it is an 
advantage to avoid, where possible, the complicated analysis of paths through homogeneous-cost regions (see 
Chapter II, Section E2b(3)). 

How realistic are the above assumptions? There are at least three issues. First, is it reasonable to expect 
that we know the characteristics of the terrain; second, can terrain be adequately modelled by piecewise linear 
curves; and third, will the use of convex non-adjacent polygons be sufficient? As discussed in Chapter I, Sec- 
tion D4, the Defense Mapping Agency and other U.S. Government agencies currently have the ability to 


produce maps which characterize terrain according to the speed at which a given vehicle type can traverse it. 


(Of course, cost in terms of time is the reciprocal of speed.) The program used to produce these maps, called 


Army Mobility Model (AMM), takes as input a digitized combination of soil conditions, vegetation, man-made 
features, and elevation which is available at present only for selected areas of the earth, but there is an ongo- 
ing effort to expand this database. As this database is expanded, AMM will be able to produce cost maps of 
more of the world’s surface, so that a path-planning system which uses AMM cost maps as input can be ex- 
pected to know the characteristics of the terrain. However, an additional consideration is that terrain may be 
impermanent. In this case our assumptions will be invalidated. 

The second issue is whether terrain can be adequately modelled using only piecewise linear curves. Com- 
putational geometry relies very heavily on the use of piecewise linear curves to approximate reality, since there 
is a fixed precision associated with any computer, and a finite amount of storage. In fact, the very concept of 
continuity is a mathematical abstraction, since at some level the most smoothly continuous curves will be seen 
to degenerate into discrete elements. For example, a wood-line may seem to form a continuous curve, when 
in fact at the scale of individual trees it is clearly discontinuous. Since the database maintained by the Defense 
Mapping Agency has a maximum resolution of 12.5 meters square, we can be assured that no representation 
we propose will be more accurate than this. One additional consideration is that small nuances of the terrain 
will normally have much less effect on optimal paths than will large features. Of course, it is always desirable 
from the viewpoint of efficiency to use as few line segments as possible to approximate a curve in order to 
reduce the number of terrain-feature vertices in the input map. 

The third question is much more of a problem. The use of convex polygons will clearly not approximate 
all types of terrain if we require that no two polygons have common vertices. The output of Army Mobility 
Model for example, allows non-convex polygons. This research uses the non-adjacent-convex-poly gon as- 
sumption in order to attack a problem of somewhat smaller scope first, with the intention of expanding the 
scope in the future to incorporate non-convex regions. The next step will be to extend the analysis of Chapter 


V to include the case of adjacent convex polygons. 


C. THE OPTIMAL-PATH-MAP APPROACH TO PATH-PLANNING 
The optimal-path-map approach to path planning groups paths according to their general behavior with 
respect to a goal point. A surjective function is defined to map optimal paths to generalizing path descriptions 


so that paths with similar behavior are mapped to the same description. The usual definition of "similar be- 


havior" is crossing the same sequence of terrain-feature vertices and edges. Boundaries are constructed to par- 
tition the plane of the map into regions whose start points have similar behavior. Then to determine an optimal 
path, a given start point is located within the partition. The path description of the region associated with the 
start point applies to the optimal path from the start point, so this path description is specialized for the given 
start point to give an optimal path. The focus of our research is the construction of the planar partition. 

How can paths be represented so they can be grouped according to their behavior? Theorem I-2 states that 
optimal paths among piecewise-linear and poly gonal terrain are always piecewise linear, changing direction 
only at terrain-feature vertices and edges. This fact suggests two possible ways to represent optimal paths. The 
more natural way to represent a single piecewise-linear path would be by listing the coordinates of its tum 
points. Alternately, we could list the terrain-feature vertices and edges at which a path turns. The first repre- 
sentation has the difficulty that there is no immediate way to tell from the list whether or not turn points from 
two different paths lie on the same terrain-feature edge. The second representation allows paths to be grouped 
more easily according to whether they cross the same terrain-feature edges and vertices, but has the difficul- 
ty that it is not clear by looking at the list what the coordinates of a tum point are on a terrain-feature edge. 
This conflict suggests a composite representation wherein a list contains terrain-feature vertices and edges, 
and for each edge, may also contains as supplemental information the exact coordinates at which the path cros- 
ses the edge. This is the representation we adopt, calling such a list a path list. 

The path list can be used to represent a specific optimal path as well as a generalized description of an 
optimal path. If a path list has a terrain-feature vertex as its first element, the path is completely determined 
because it will go from the start point directly to the vertex, from where a unique path goes to the goal (Corol- 
lary 1-3.1, Appendix A). If a path list has an edge as its first element and no supplemental information is in- 
cluded with that edge, the path list represents all optimal paths whose first turn point lies on that edge. If 
however, coordinates ofthe crossing point are included with the edge, the path is completely determined. When 
listing an edge in a path list, it is also important to distinguish between edges crossed from different directions, 
because for example, paths may enter the same portion of a road from both sides; we want to distinguish be- 
tween the two sets of paths which come from either side of the road. For consistency in our discussions, we 
adopt the convention that for a start point with no feasible paths (for example, a start point inside an impass- 


able obstacle), the optimal-path list is a null symbol concatenated with the goal point. 


Now the path- generalizing function can be defined more fully for the usual definition of similar behavior 
of paths. For the set O of all optimal paths and the set (YJE)* of all combinations of terrain-feature vertices 
and edges, the function f : O —(VUE)* maps an optimal path to its path list. 

Define a homogeneous-behavior region with respect to a goal G as the set of all start points whose op- 
timal paths are mapped by the path-generalizing function to the same set. Thus, start points whose optimal 
paths have the same path lists are considered to be in the same homogeneous-behavior region for the usual 
definition of the path-generalizing function. Define the root of a homogeneous-behavior region as the first ele- 
ment of the path list associated with the region. Since a root may represent a terrain-feature edge which can 
be crossed at any point along its length, the supplemental information cannot be retained by the path list as- 
sociated with the root. Define a homogeneous-behavior boundary as the locus of points lying in two 
homogeneous-behavior regions. On a homogeneous-behavior boundary (except for obstacle edges), at least 
two optimal paths exist for a given point. 

The fundamental principle upon which spatial reasoning about optimal paths is based is the principle of 
optimality. In its general sense, the principle of optimality states that if it applies to a system, future optimal 
policy in the system depends only on its current state and not on its past history. Theorem 1-1 (Appendix A) 
states that the principle of optimality applies to the path-planning domain. In other words, it states that the 
portion of an optimal path from any point on the path to the goal is also an optimal path. 

We extend the general-position assumption discussed above to terrain feature edges by adopting the con- 
vention that any terrain feature edge intersected by a homogeneous-behavior boundary is to be treated as two 
distinct edges, one on each side of the boundary. The immediate result of this assumption, the principle of op- 
timality, and Theorem I-2, is the uniqueness of optimal paths from any terrain feature vertex or across the in- 
terior of any edge. (Corollary I-3.1, Appendix A.) It follows from the definitions of homogeneous-behavior 
regions, roots, and boundaries, the general-position assumption, and Theorem I-2 that there is a unique root 
associated with each homogeneous-behavior region (Corollary I-3.2). It also follows that homogeneous-be- 
havior regions are "star-shaped" with respect to the region root (Corollary I-3.3). 

An optimal-path tree of a set of terrain features with respect to a goal point is the index tree for all pos- 
sible path lists. In other words, it is the tree whose root represents the goal and whose internal nodes are ter- 


rain-feature vertices and edges, such that for each node, the optimal paths from that node's vertex or edge go 


first to the vertex or edge represented by the node’s parent. Therefore, the path list for the vertex or edge as- 
sociated with a node is found by following the parent pointer of the node back to the root of the tree, which is 
the goal. Each node of the tree corresponds to a unique homogeneous-behavior-region root, which corresponds 
to a unique homogeneous-behavior region. Thus, locating a start point in a region of the planar partition is 
equivalent to specifying which node of the tree identifies the behavior of the optimal path from that start point. 
Figure 2 shows an example planar partition with its corresponding optimal-path tree. 

An initial version of the optimal-path tree can be constructed by using a point-to-point path planner to 
compute the optimal path from each terrain-feature vertex on the input map and then inserting the tum points 
of each resulting optimal path into a tree. The method presented in Chapters V and VI uses the optimal-path 
tree to construct the planar partition, and revises 1t by inserting nodes which correspond to terrain-feature edges. 
However, the method presented in Chapter III constructs the optimal-path tree at the same time as it constructs 
the planar partition. 

An optimal path map or OPM 1s a partition of the plane into homogeneous-behavior regions with respect 
to a goal, along with its associated optimal-path tree. There is a finite optimal-path tree associated with every 
two-dimensional map consisting of terrain as defined above (Theorem 1-4, Appendix A). The specification of 
this optimal-path tree is a necessary part of the optimal-path map, and we will assume that the term optimal- 
path map implies both the representation of the planar partition and of the optimal-path tree, with some means 
of linking each node with its corresponding homogeneous-behavior region in the partition. À typical repre- 
sentation of the planar partition is the doubly-connected-edge-list discussed in Chapter II, Section B. 

Several partitioning algorithms for terrain containing only obstacles (the binary case) have been proposed 
in an attempt to present faster solutions to the point-to-point path-planning problem (see Chapter 2), and several 
algorithms even solve a portion of the optimal-path-map problem with respect to weighted regions by creat- 
ing the optimal-path tree in pursuit of single-path solutions. In this research, we investigate the problem of 
creating an optimal-path map for weighted-region terrain, focusing on a solution to the optimal-path-map 
problem as an end in itself. We choose to investigate this approach because it offers the most opportunity for 
enhancement of run-time performance at the expense of preprocessing time because of the promise of O(log 


n) run-time complexity to identify an optimal path for a map of n terrain-feature vertices. 
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Planar Partition with Corresponding Optimal-Path Tree 
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D. SUMMARY OF RESEARCH REPORTED HEREIN 

In Chapter II, we explain and classify the path-planning algorithms relevant to this research, specifically 
those dealing with negligible-sized agents in a fixed, known environment where terrain is two-dimensional, 
free space. 

One method of obtaining sub-optimal solutions to the optimal-path-map problem uses a version of tbe 
standard wavefront propagation algorithm. Such an algorithm is presented in Chapter III, and the extensions 
necessary to create optimal-path maps are developed. Chapter IV is an analysis of the algorithm in tbe pre- 
vious chapter. Two primary sources of error are examined, and known results of inherent inaccuracy in 
wavefront propagation are extended to the resulting OPMs. The theoretical time and space complexity of the 
above algorithm is presented, along with empirical results concerning execution times for three alternative 
heuristics used with tbe algorithm. 

A second approach to solving the two-dimensional optimal-path-map problem is to reason about how op- 
timal paths behave in the presence of various terrain features, This reasoning leads to analytical characteriza- 
tion of the boundaries between homogeneous-behavior regions of similarly-behaved optimal paths as functions 
of terrain feature characteristics. It turns out that all boundaries generated by the roads, rivers, and obstacles 
are segments of conic sections. Other boundaries are more mathematically complex, and in many cases can- 
not be described in closed-form expressions. First in Chapter V, a set of definitions is presented, followed by 
development of the characterizations of boundaries generated by "primitive" terrain feature types, i.e., single 
polygons and single line-segments. Then the characterization of more complex combinations of primitive ter- 
rain features is discussed, and decomposability is defined for construction of optimal-path maps. 

In Chapter VI, algorithms use the results of Chapter V to generate OPMs more accurate than those of 
Chapter III for isolated occurrences of each type of primitive terrain feature. Then an algorithm based on the 
divide-and-conquer paradigm is presented to generate OPMs for some "decomposable" maps with multiple 
terrain features. In Chapter VII the divide-and-conquer exact-OPM algorithm is analyzed, first in terms of 
sources of error, and then with respect to theoretical time and space complexity. Then the empirical perfor- 


mance of an implementation is discussed. Chapter VIII summarizes the results of the research. 


IIl. RELEVANT RESEARCH 


A. APPLICABLE CONCEPTS FROM ARTIFICIAL INTELLIGENCE 
1. Search Methods 

One of the central problem-solving techniques in Artificial Intelligence is the use of search [Ref. 5], 
[Ref. 6]. A search problem is couched in terms of a current state and a goal state, operators are defined which 
transform the system from one state to another, and a search is conducted for a sequence of operators which 
will transform the current state to a goal state. Conceptually, a search space is a directed graph whose nodes 
represent all possible states, and whose edges represent operators. Solving the problem means applying graph- 
search algorithms in the search space to find a path from a start node to a goal node. The search space may be 
a very large, even an infinite graph which is not represented explicitly, but as the algorithm proceeds, it creates 
a sub-graph, called a search graph (or search tree), whose nodes are the states actually reached during the 
search. The underlying aim is to find ways to make the search graph as small as possible while still including 
the goal state, i.e., to look at as few states of the search space as possible on the way to finding the goal. There 
are two ways of limiting the size of the search graph. One way is to guide the search by means of heuristics, 
and the other is to represent the problem in such a way as to reduce the search space. 

When no domain-specific information is used to guide decisions about which node of the search graph 
to process next, the process is called blind search. Although few problems have a search space small enough 
to allow practical use of blind search, the techniques used provide the foundation for heuristic search, where 
information is used to guide the search. All the search techniques discussed below can be said to conform to 
a general model where the search is initialized by placing an initial node on an agenda, and proceeds by ex- 
panding the first node on the agenda, putting the node's children on the agenda in a manner which varies from 
technique to technique. 

Branch-and-bound search, also known as Dijkstra's algorithm, is a generalization of breadth-first 
search which uses heuristic information. The distance of a node from the start is not measured by the number 
of edges from the node to the root as in breadth-first search, but by the total cost of the edges. Thus, each edge 


has an associated cost, and at each iteration, after a node has been expanded and its children placed in the agen- 


da, the agenda is sorted by cost to keep lower-cost nodes first. Since physical distance is the normal metric in 
the path-planning domain, this is a natural search technique to use. This technique guarantees that the first path 
found to the goal is the lowest-cost solution. 

Another search strategy which is widely used in path planning is called A* search. It sorts its agen- 
da according to the sum of the cost function and evaluation function at each node. If the evaluation function 
value from any point to the goal is a lower bound on the actual cost from the point to the goal, it is guaranteed 
that the first time the optimal path to the goal is selected from the agenda it will be recognized as optimal. 

2. Domain-Specific Heuristics as Guides to Search 

General solutions to problems tackled by Artificial Intelligence researchers are usually so difficult 
that great advantages are to be gained by finding rules-of-thumb to focus the search in the right direction. 
Heuristic search strategies use cost and/or evaluation functions to guide the search. Rich [Ref. 7] states that 
the field of artificial intelligence is largely the study of heuristic search for solving difficult problems, and The 
Handbook of Artificial Intelligence calls heuristic search "one of the key contributions of Artificial Intelligence 
to efficient problem-solving" [Ref. 5]. In the path-planning domain, there is a natural heuristic which is often 
used to guide search for an optimal-cost path, which is that for a path from the start point to an intermediate 
point, if the intermediate point is closer in straight-line distance to the goal than some other intermediate point 
from another path (irrespective of terrain yet to be negotiated),the first path is preferred over the second for 
further exploration. 

3. Problem Representation 

It is often the case in problems studied in artificial intelligence research that a problem which seems 
very difficult when represented in one way will suggest a natural solution when represented in a different way. 
In other words, finding a good problem representation is often the key to efficient solution of the problem, as 
well as to clear understanding of the problem on the part of researchers [Ref. 5]. Path-planning algorithms, for 
example, are essentially ways of transforming i infinite search space to a finite one, and then searching the 


transformed search space using one of several heuristic-aided search algorithms discussed above. 
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B. APPLICABLE CONCEPTS FROM COMPUTATIONAL GEOMETRY 
1. Definitions for Optimal-Path Maps 
a. Path List 

When optimal paths are guaranteed to consist of line segments between a finite number of turn 
points, which Theorem 1-2 shows is true of the terrain considered in this research, they can be represented by 
listing these turn points. It is also shown in Theorem I-2 that these tum points occur only at terrain-feature ver- 
tices and edges. This suggests two possible ways to list the turn points. The most direct way is to list the coor- 
dinates of the points. This allows direct reconstruction of the path from its list. However, this representation 
makes it somewhat more difficult to compare two lists to determine if the paths they represent cross the same 
edges. It might be better to list explicitly the vertices and edges that a path crosses. This representation has the 
drawback, however, that some computation would be necessary to determine for each edge crossing exactly 
where the crossing occurred. Since our research is primarily concerned with grouping paths together accord- 
ing to their general behavior, we adopt the second representation, calling such a list a path list. An example 
path list from start point S to goal point G in Figure 3 is [E,A,G], while from point R there are three possible 
good path lists of [F,C,G], [H,G], and [PQ,G]. For consistency in later discussions, we say that for a start point 
with no feasible paths (for example a start point in the center of an impassable obstacle), the path list consists 
of a special null symbol concatenated with the goal point. 

b. Path-Generalizing Function 

The concept upon which the optimal-path-map approach to path planning is based is that paths 
can be grouped according to their behavior. A path-generalizing function f.O—B is defined from the set of 
optimal paths to the set of behaviors of optimal paths, which maps an optimal path to a description of its be- 
havior. Since many paths may share the same behavior descriptions, f is a surjective function. The usual way 
to define the behavior of a path is by listing the vertices and edges it crosses. In that case B = (VUE)*, the 
set of all combinations of terrain-feature vertices and edges. Since path lists are defined in terms of vertices 
and edges, the usual definition of f is that it maps an optimal path to its path list. 

A path-generalizing relation R which relates two points if the path-generalizing function maps 


their optimal paths to identical path lists is an equivalence relation because the identity relation is in general 
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an equivalence relation. Since the domain of f is the set of all points on the input map, f induces a partition on 
the plane of the input map through this equivalence relation. 
c. Homogeneous-Behavior Region 

Define a homogeneous-behavior region with respect to a goal point and a path-generalizing func- 
tion as the set of start points whose optimal paths to that goal point are mapped by the path-generalizing func- 
tion to the same path behavior. In our work, this is equivalent to saying that it is the set of start points whose 
optimal paths have the same path lists. Each homogeneous-behavior region corresponds to an equivalence 
class of the path-generalizing relation R, and so is a subdivision of the partition induced by R on the plane of 
the input map. In Figure 3, for example, point S is in the homogeneous-behavior region enclosed by segments 
EI, IK, KL, and LE. 

An optimal-path map (OPM) is defined as the partition of the plane of the input map into 
homogeneous-behavior regions, along with their associated path lists. For the conceptual representation of an 
optimal-path map shown in the top half of Figure 3, the two data structures in the bottom half of the figure 
fully specify the OPM. 

d. Homogeneous-Behavior-Region Root 

Because of the definition of homogeneous-behavior regions, each unique path list defines a 
homogeneous-behavior region. Thus given a path list, the associated region is defined. By the general-posi- 
tion assumption (Assumption J-3, Appendix A), there will be no accidental alignment of boundaries from 
another region such that there is more than one path list from a region. The first element of the path list as- 
sociated with a region is defined as the homogeneous-behavior-region root. For example, in Figure 3 the path 
list of start point S with respect to goal point G is [E,A,G], and point E is the region root of the region of which 
S is a member. 

2. Data Structures 
Several data structures with wide utility in computational geometry are useful in the optimal-path- 
map domain. Since an optimal-path map consists of the set of path lists from homogeneous-behavior-region 


roots and a planar partition, these two items must be represented. 
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a. The Optimal-Path Tree 

The optimal-path tree is a way of representing a set of path lists. It is a direct extension of the 
shortest-path tree concept [Ref. 8]. An optimal-path tree (OPT) is a tree whose root (not the same as a 
homogeneous-behavior-region root) is the specified goal point, whose nodes are terrain-feature vertices and 
edges, and for which an optimal path from the terrain-feature vertex or edge represented by any node in the 
tree goes directly to the vertex or edge represented by that node’s parent. Each node of the tree corresponds 
to a homogeneous-behavior region, and every homogeneous-behavior region is represented by a node. (see 
Theorem I-4, Appendix A). Thus by labeling regions and OPT nodes the same, or by establishing pointers 
from regions to nodes of the OPT, a linkage is established which allows retrieval of the appropriate OPT node 
given a region. Then the path list associated with the region can be reconstructed by tracing upwards through 
the tree to the tree’s root. Note, however, that further computation usually is necessary to reconstruct the op- 
timal path from the path list by finding optimal edge crossings. Another important characteristic of the op- 
timal-path tree is that it reduces the redundancy of storage of optimal paths associated with terrain-feature 
vertices and edges by integrating them all into one structure. In Figure 3, the optimal-path tree is shown for 
the given terrain map. 

b. The Doubly-Connected Edge List (DCEL) 

A planar partition could be represented in edge-list form in which, for each vertex of a piecewise- 
linear approximation of the boundary between subdivisions of the partition an ordered list of its incident edges 
is given. Although this is a natural representation, some of the information implicitly present could be explicit- 
ly listed, enhancing efficiency at the expense of preprocessing time and storage. A doubly-connected edge list 
is such a data structure that has proven to be quite useful in representing a planar partition. Represent each 
edge as a node in the DCEL, and label each edge, vertex, and region. Note that the terms edge and vertex as 
used in connection with the DCEL refer to piecewise-linear homogeneous-behavior-region boundary edges 
and vertices, not to terrain-feature edges and vertices. With each edge-node, associate a six-tuple of data ele- 
ments (V1,V2,R1,R2,P1,P2). The Vi are the two vertices of the edge. The assignment of vertices to the two 
fields V1 and V2 1s arbitrary, but once assigned is fixed. Once the vertices are assigned, the edge becomes 
directed from Vj to V2, Ry is the region (or face in the terminology of computational geometry) to the left of 


the edge, and R2 1s the region to the right. P; is a pointer to the edge-node which is adjacent to edge Vj V2 in 
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a counterclockwise rotation about V1, and similarly for P2 with respect to V2. A partial listing of the DCEL 
for the optimal-path map of Figure 3 is also shown. [Ref. 8] 

For a DCEL representing a partition with n vertices, a single pass in time O(n) can create arrays of 
headers of vertex and region linked lists, so that straightforward algorithms can retrieve the sequence of edges 
incident on a vertex or enclosing a region, in time proportional to the number of edges involved. A graph in 
edge-list form can be transformed to a DCEL in time O(n). [Ref. 8] 

An extension of the DCEL allows curved edges, as well as piecewise-linear ones, to be represented. 
Additional fields for each edge-node can be added to the DCEL to represent the algebraic form of the curve 
and to represent additional parameters necessary to specify the curve analytically. For example, if a curve rep- 
resented a segment of a hyperbola, the entry in the first additional field would note that, and the second addi- 
tional field would contain the two parameters of the equation of a hyperbola. Two points on the hyperbola, the 
endpoints of the se gment, are listed in the DCEL, so the hyperbola segment is fully specified. 

3. ThePlane Sweep Paradigm 

Many algorithms in computational geometry follow the plane sweep paradigm. The idea is to process 
a geometrical structure in the plane in an ordered fashion, normally by sweeping an imaginary vertical line 
from left to right from event point to event point, where an event point is a point in the plane at which some 
action may need to be taken. Two data structures are useful in conducting a plane sweep, an event-point 
schedule and a sweep-line status. At any point along the sweep axis, the geometrical structure is characterized 
by a status which is the relation of the vertical line to the geometrical structure. For example, the status may 
be an ordered list of line segments of the structure which intersect the sweep line. This status will change at a 
finite number of points along the sweep axis for a finitely-describable structure. These changes in status are 
the places at which the problem must be processed or analyzed. These points along the sweep axis are main- 
tained 1n the event-point schedule. The event-point schedule ts often some form of a queue. [Ref. 8] 

4. Point-Location in the Cartesian Plane 

Linked to any algorithm that partitions the Cartesian plane in order to represent properties of points 
in each region is the requirement to retrieve those properties when queried about any point in the plane specified 
by its coordinates. Algorithms that build optimal-path maps are partitioning the plane into regions such that 


each region contains those start points with similarly-behaved optimal paths to a given goal-point. It is neces- 


sary to determine in which region the point lies. If the boundaries between regions are piecewise-linear cur- 
ves, there are several algorithms from computational geometry which can be used to locate a point in the planar 
partition. 

The slab method of point location in a planar partition draws a horizontal line through each vertex of 
the partition, and then sorts the regions (or slabs) lying between horizontal lines from top to bottom during 
preprocessing. This allows location of the point within a slab in O(log n) time by use of bisection search based 
on the y-coordinate of the point, where n is the number of vertices in the partition. Line segments which com- 
prise the boundaries of the partition cross through each slab. Within a slab they can be ordered from left to 
right because at no point in the interior of a slab do two line segments intersect, since the slabs were defined 
by drawing horizontal lines through all the intersection points of the partition. Then bisection search can be 
used to locate the point honzontally between line segments within the slab in O(log n) time, for a total loca- 
tion ime of O(log n + log n) = O(log n). Two disadvantages to this method are the requirement for preprocess- 
ing time and storage space. Preparata and Shamos show how to reduce the basic O(n? log n) preprocessing 
time to O(n’) using a plane sweep approach, but the algorithm requires at worst O(n’) space. [Ref. 8] 

A second point-location method is the chain method. Instead of dividing the planar graph honzon- 
tally with slabs, it finds vertical chains, or connected line segments, of edges, which are monotone with respect 
to the y-axis, i.e., such that no two points on the chain have the same y-coordinate. It then constructs two bi- 
nary search trees, the first having those chains as nodes and tbe second having segments of chains as nodes. 
The two trees can be traversed in O(log” n) time to locate a point. A DCEL can be preprocessed in O(n log n) 
time into the two binary search trees. which take at worst O(n) space. [Ref. 8] 

Another point-location method is the triangulation refinement method. A set of connected line seg- 
ments is said to be triangulated if each vertex is connected by a line segment with at least two other vertices, 
i.e., the line segments all form triangles. The planar partition is triangulated in O(n log n) time by standard 
methods from computational geometry, and a hierarchy of triangulations is constructed upon which to search. 
This method leads to O(log n) query time, O(n log n) preprocessing time, and O(n) storage. [Ref. 8] 

An extension of the chain method, the bridged chain method, uses an elegant method that permits 
search in O(constant) time for subsequent searches, after a higher cost for a first search. It happens that the 


chain method meets the conditions for application of the bridging technique, and so bridging is used to ac- 
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cumulate information during the search process. This technique brings the chain method to efficiency com- 
parable with the triangulation refinement method. [Ref. 8] 

Although the above two methods achieve the theoretically optimum worst-case bounds, there may 
be sub-optimal methods which afford better practical performance. Specifically, the trapezoid method, which 
could be considered an extension of the slab method, gives an O(log n) query which always succeeds in fewer 
than 4 log nh 3 tests, and uses O(n log n) storage and preprocessing time. Actually, average-case storage 
may be O(n). This method has the additional property that it may be extended to curvilinear edges, so it may 
be especially useful in our application since instead of approximating curves piecewise-linearly, they may be 
represented exactly by their analytical form. [Ref. 8] 

A problem with the slab method was the O(n’) worst-case space complexity, where n is the number 
of vertices of the graph representing the planar partition. This problem was due to the possibility that edges 
could span most of the horizontal slabs, each such edge needing to be segmented into O(n) fragments. In the 
trapezoid method, it can be shown that no more than 2 log n fragments will ever be needed for any edge, so 
no more than O(n log n) space is required. The trapezoid method defines a trapezoid as having two horizon- 
tal sides and two other sides which may be unbounded, or else if they exist are edges of the graph not inter- 
rupted by vertices. The basic operation of the algorithm is to split a trapezoid into subordinate trapezoids. The 
progress of the splitting algorithm is paralleled by the building of a balanced binary search tree which repre- 
sents a hierarchy of subordinate trapezoids. This tree can then be searched to locate a point in a trapezoid. 
Figure 4 (adapted from Preparata and Shamos [Ref. 8]) shows an example trapezoid with its corresponding 
search tree. 

The splitting operation for the trapezoid method proceeds by finding the median y-coordinate among 
the vertices contained in the current trapezoid T and dividing T into two "slices" T and T2 by drawing a 
honzontal line through the median vertex. Then those edges which intersect the top or bottom horizontal side 
of T are scanned from left to mght, and the first edge which also intersects the newly drawn horizontal line, 
i.e., which spans T1 or T2, defines a new trapezoid T3. The scan continues until all edges which span T1 or T2 
are found, with a new trapezoid being generated for each spanning edge. Note that edge e] defines the first 
new trapezoid T3 in Figure 4 because it spans the top and median lines of T. T3 will not need to be further split 


because there are no vertices contained in it. Spanning-edge e2 is found next, and creates Te. Finally ez is 
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found, creating T4. No other spanning edges are found, so T5 and T7 are also defined. T4, T5, T6, and T7 all 
contain vertices of the graph in their interiors, so they will need to be split further in subsequent iterations of 
the algorithm. Triangular nodes of the search tree represent horizontal splits at graph vertices, while circular 
nodes represent the definition of new trapezoids by spanning edges. There will be n-2 triangular nodes of the 
tree, one for each except the left and right extreme vertices of the graph. Edges may form the sides of more 
than one trapezoid, however; in fact they may be fragmented into as many as 2 log n segments, as stated above. 
Thus the search tree may have as many as O(n log n) nodes, which is the worst-case space complexity. The 
tree corresponding to the trapezoids found in Figure 4 is also shown. 

The depth of the balanced search tree can be shown to be no more than 4 | log nk 3, SO a search of 
the tree will take no more than that many steps. Thus the worst-case time complexity to locate a point in the 
planar partition is O(log n). Since there are O(n) edges and each edge may be segmented into O(log n) frag- 
ments, the time required to process the edges is O(n log n), while both the median-finding and the tree-balanc- 
ing may be done in O(n log n) time. Thus the preprocessing required is O(n log n). 

An added advantage which could be useful to our research is that the trapezoid method can be ex- 
tended in some cases to finding a point among edges which are not straight-line segments. This can be done 
if first, the curves can be expressed as a single-valued function of one of the coordinates, and second, if it can 
be determined in constant time whether a point is on one side or the other of the curve. 

5. Intersections Among Line Segments in the Cartesian Plane 

A common operation of the algorithms proposed in Chapter VI is to find intersections between two 
piecewise-linear curves. It is thus important to find efficient methods of doing this operation. The intersection 
of two piecewise-linear curves with p and q segments respectively would take, using the naive approach which 
compares each segment of one curve with each segment of the other, O(pq) line segment intersections, so it 
is important to find better ways of doing the operation. 

Preparata and Shamos present an algorithm to find all intersections among n line segments by per- 
forming a plane sweep along the x-axis. At any point on the x-axis, a vertical line imposes a total order on 
those line segments it intersects. This order is recorded in the sweep-line status. As the vertical line sweeps to 
the right from intersection point to intersection point, new line segments may be added to the ordering, and 


old ones deleted, but if any adjacent pair of line segments changes order, which is detected by a change in the 
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sweep-line status, an intersection of those segments must have occurred. Thus, any line segment which is added 
to the ordering is checked for intersection with the segment immediately above and below it by checking if 
the relative order changes at the point along the x-axis where the first of the two segments will be deleted. This 
approach can detect k intersections among n line segments where n is p+q in time O((n+k) log n). In our domain 
however, any two bomogeneous-belavior-region boundaries will intersect in at most one point, because when 
any two boundaries intersect, a third boundary will begin and the other two will end. Therefore we could use 
a simplification of the above algorithm which will operate in O(n log n) time. [Ref. 8] 

Intersection calculation for piecewise-linear curves with monotonic curvature can exploit these 
properties. Several algonthms of uncertain worst-case complexity seem to provide good empirical results. One 
in particular [Ref. 9] proceeds by constructing, in O(p) time, a bounding box for the first piecewise linear 
curve, and then checking, in O(q) time, which portion of the second curve, if any, intersects the bounding box. 
The intersecting portion of the second curve usually contains only a small fraction, call it k1, of the whole 
curve, although it is at this point that the analysis becomes imprecise because ki does not depend on p or q, 
but on the curvature and relative positions of the two curves. In any case, the next step is to reverse the roles 
of the two curves and create another bounding box about the k1q line segments of the second curve, in O(k1q) 
time. The first curve is intersected with the new bounding box in O(p) time, finding k2p segments which 
traverse the new box. The algorithm proceeds recursively as above, terminating when one of the bounding 
boxes contains only one line segment. At this point, the next check of the other curve will yield the exact in- 
tersection point. A rough approximation of the time complexity of this algorithm, if it is assumed for simplicity 
that at each stage the size of the curve is reduced by the same fraction k, is T = ((1+k)q + 2p)/(1-k) + 1. Thus 
this algorithm has, assuming O<k<1, time complexity O(q+2p) = O(q+p) = O(n). This algorithm will not con- 
verge if at any stage the bounding box of each partial curve completely contains the other partial curve. But a 
simple check during each iteration to ensure that the sizes of the two curves are in fact decreasing will allow 
the method to proceed if it is converging. If it fails this test, a full O(pq) test of the two curves can be used in- 
stead. 

6. Voronoi Diagrams 
A technique in computational geometry that has been of use in some algorithms pertaining to op- 


timal-path maps is Voronoi diagram construction (Ref. 8]. A Voronoi diagram Vor(S) with respect to a set of 
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points S in a plane is the partition of the plane such that each region contains the points with the same nearest 
neighbor in S. Figure 5 shows a typical Voronoi diagram. One method for constructing shortest-path maps 
(i.e., an optimal-path map for binary terrain), uses an extension of Voronoi-diagram methodology to plot ap- 
proximations of the boundaries between homogeneous-behavior regions [Ref. 4]. It reduces the problem of 
constructing the planar partition to that of finding a Voronoi diagram for the vertices of an obstacle, where the 
costs of optimal paths from each vertex is known. Instead of bisectors between two vertices which are straight 
lines exactly half-way between them as described below, this method constructs bisectors which are either 
lines or hyperbola branches, depending on the nature of the paths from the two vertices. Then the Voronoi 
diagrams of single obstacles are merged to form the complete OPM. 

Some observations about Voronoi diagrams lead to an initial construction method. Between two 
points P; and P2 in the plane, the set of points closer to P, than to P2 are the points in a half-plane containing 
Pı defined by the pedi cular bisector of the line segment P1P2. Among a set S of n points in the plane, the 
set of points closer to a point P; than to any other point in $ is the intersection of n-1 half-planes each contain- 
ing Pj defined by the perpendicular bisectors of the line segments PjP}. From this observation, a brute-force 
method of constructing a Voronoi diagram would be simply to construct each of the n polygons about each 
point in S. Since n half-planes can be intersected with each other in O(n log n) time by a divide-and-conquer 
approach, this approach takes time O(n? log n). [Ref. 8] 

A more efficient approach for constructing Voronoi diagrams which also uses the divide-and-con- 
quer paradigm can be summarized as follows. First, partition S into two sets S; and 52 of roughly equal size 
according to whether the x-coordinate of each point is less than or greater than the median x-coordinate of 
points in S. Then, construct Vor(S1) and Vor(S2) recursively, and finally, merge Vor(S1) and Vor(S2) to ob- 
tain Vor(S). Partitioning S takes O(n) time for a set S of size n using a standard median-finding algorithm and 
the merging step takes O(n) time. If the entire algorithm can be performed in T(n) steps, the construction of 
both subordinate Voronoi diagrams in step two takes approximately 2T(n/2) time. So the recurrence relation 
T(n) = 2T(n/2) + O(n) describes the algorithm, which when solved gives that T(n) is O(n log n). 

The merging step is the heart of the algorithm, and ts accomplished as follows. Because the map is 


partitioned such that 5; and S2 will lie on opposite sides of a vertical line, it can be shown that there is a chain 
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O, i.e., a sequence of connected line segments, which is monotonic with respect to the y-axis, (1.e., no two 
points of the chain have the same y-coordinate ) that also partitions the plane with S; and S2 on opposite sides 
of O such that the union of the portion of Vor(S1) which is left of O and the portion of Vor(S2) which is right 
of O yields Vor(S). In fact this chain O can be constructed in linear time, so the recurrence relation stated 
above holds, and the construction of a Voronoi diagram can be done in O(n log n) time. [Ref. 8] 

Generalizations of Voronoi diagrams have been presented which partition the plane into sets of points 
closest to a set of line segments [Ref. 10], or which base their distance function on metrics other than the 
Euclidean metric [Ref. 11]. Since OPMs for homogeneous-cost areas can be thought of as Voronoi diagrams 
with a different metric for each homogeneous-behavior region, the latter work seems promising. Currently, 
however, only several simple metrics such as L¡ and Loohave been considered, so more research in this area 
is necessary before OPMs of the type we are considering can be constructed with this approach. Weighted 
Voronoi diagrams [Ref. 12] assign a weight to each point about which regions are computed. This concept 
might appear useful in constructing OPMs, but is not. Instead it applies to a problem in which a mobile agent 
travels at different speeds depending on which terrain-feature vertex it just crossed. 

What is needed in constructing OPMs for the binary case is a type of generalized Voronoi diagram 
in which the weight is the cost-rate of the region in which an obstacle vertex lies, and an offset of the initial 
weight at the vertex represents the cost of the optimal path from the vertex. This is, in essence, what the mgo- 
rithm of Aronov [Ref. 13] computes. This algorithm allows points in the Voronoi set to be given an initial of- 
fset weight. Knowing that bisectors between such points are hyperbolas (or in the degenerate case, lines), they 
can be plotted just as in the basic Voronoi diagram algorithm. The key element of the method is the proof that 
a dividing chain can be constructed between two Voronoi diagrams as discussed above, which now can con- 
tain hyperbola segments as well as line segments. This allows smaller generalized Voronoi diagrams to be 


merged into larger ones, which is the foundation of the divide-and-conquer approach used. 


C. DEFINITIONS OF RELEVANT FREE-SPACE PATH-PLANNING PROBLEMS 
This thesis addresses problems where the mobile agent is of negligible size with respect to the surround- 


ing terrain, where terrain is two-dimensional free space with fixed terrain features, where the environment is 
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stable and knowledge about it is complete, and where the optimality criterion is to minimize a cost function 
which is linear in path length. 

A simplified version of this problem has been called by Lozano and Wesley [Ref. 1] and Brooks (Ref. 
14] the FIND-PATH Problem, and by Mitchell (Ref. 15] the OBSTACLE-AVOIDANCE Problem. This 
simplified problem seeks any feasible path in terrain consisting of impassable obstacles on a homogeneous- 
cost background. An important extension to the FIND-PATH Problem includes the optimality criterion that 
the resulting path be the shortest among all feasible paths. It is called the OBSTACLE-AVOIDANCE 
SHORTEST-PATH Problem, or simply the SHORTEST-PATH Problem. 


OBSTACLE-AVOIDANCE SHORTEST-PATH Problem: Given a mobile agent A of negli- 
gible size with respect to the environment, an environment E consisting of impassable obstacles at 
fixed and known locations on a homogeneous-cost background, and motion objective O consisting 
of the translation of A to a specified goal point in the environment, find a continuous path 7t for A 
amidst E that achieves objective O such that its length is minimal among all feasible paths, or report 
that no feasible path exists. 


Realistic terrain for large-scale cross-country path-planning can rarely be modelled as binary (i.e., 
obstacles on a homogeneous-cost background). À more useful assumption is that terrain can be modelled as 
homogeneous-cost regions. The map is consists of regions, each assigned a value representing the cost rate to 
the agent to traverse the region. The weighted-region problem is a generalization of the obstacle-avoidance 
shortest-path problem which defines terrain as homogeneous-cost regions. 


WEIGHTED-REGION Problem: Given a mobile agent À of negligible size with respect to en- 
vironment E, E consisting of a partition of the plane into fixed homogeneous-cost regions of known 
position, and motion objective O consisting of the translation of A to a specified point in environ- 
ment E, find a continuous path TT for A amidst E that achieves objective O such that the path in- 
tegral of the cost is minimal, or report that no feasible path exists. 


The U.S. Army Engineer Waterways Experiment Station, the U.S. Army Engineer Topographic 
Laboratories (ETL) and the Defense Mapping Agency (DMA) currently can produce such cost-rate maps of 
environments E using a program called Army Mobility Model (AMM), for portions of the earth for which 
digitized terrain data is available. This data includes not only elevation data, but cultural, vegetation, and soil 
data as well, and must currently be collected in part manually (Ref. 16]. The output of AMM is a map in which 
terrain is subdivided according to the maximum speed with which the given vehicle could be expected to 


traverse the terrain. 
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If an application will require repeated solutions of the shortest-path or weighted-region problems, it may 
be more efficient to construct an optimal-path-map which represents optimal paths to a given goal point from 
all start points in the plane. If the output map represents solutions to the shortest-path problem, it is called a 
shortest-path-map. Some authors use shortest-path-map to refer to maps of the weighted-region problem as 
well, allowing the word shortest to mean shortest with respect to a specified cost function. We prefer the term 
optimal-path-map, however, to emphasize its basis in the weighted-region problem. 


FIXED-GOAL OPTIMAL-PATH-MAP Problem: Given mobile agent A of negligible size with 
respect to environment E, E consisting of a partition of the plane into fixed, homogeneous-cost 
regions of known position, and a set of motion objectives © which are to translate agent A from 
each of the continuum of start points S in the plane to a goal point G, represent the set II of con- 
tinuous paths for A in E that achieves objectives O; in O such that the path integral for each TT; ¡is 
minimal over all paths from start point S; to G, or report that no feasible path exists. 


D. TYPES OF PATH ERRORS 
Several classes of errors may occur in algorithms which look for optimal paths. Each algorithm is based 
on a model of the path-planning domain with its own representation of reality, and operations manipulate that 
representation to produce a solution. For example, terrain in some models is represented by imposing a grid 
on the map and assigning a cost to each cell of the grid, while in some models terrain is represented by polygons 
with an assigned cost. Errors may occur either because of inaccuracies in operations within the model or be- 
cause of inaccuracies in the model compared with the real-world domain. The first class below are errors of 
the former type, while the second and third classes are errors of the latter type. 
1. Cost of Model Computed Path versus Cost of Model Optimal Path 
Path-planning algorithms execute within the context of their model of real-world terrain. If an algo- 
rithm produces a solution path which has a computed cost greater than the minimum cost of some other path 
represented within the model, the algorithm has produced a model sub-optimal path. Such a solution may occur 
either intentionally or unintentionally. Some algorithms terminate when a candidate solution is guaranteed to 
be within some bound of the true model optimal solution, thus saving processing time at the expense of ac- 
curacy. An example of this type of algorithm is a variation of A* called A*e [Ref. 17]. Another example of 
an algorithm which produces solutions with this kind of error is called simulated annealling. It uses stochas- 


tic methods to determine when a candidate solution has a high probability of being good enough [Ref. 18]. Er- 
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rors of this type also occur because of numerical errors in the mathematical operations performed by the al- 
gorithm. Standard numerical analysis techniques can be used to study these errors and attempt to reduce them. 
2. Cost of Model Optimal Path versus Cost of Real-World Optimal Path 
When the cost of the optimal path within the model is different from the actual cost of a path between 
the same two points in the real world, an error of the second class has occurred. Even the actual measurement 
of a path cost is only an approximation of reality, so any model produces at least some small error of this kind. 
The amount of this kind of error produced is an important consideration in choosing among algorithms. For 
example, as discussed in Section E below, the wavefront propagation algonthm may produce solutions which 
are optimal in its grid-based model, but which have as much as 7.6% greater cost than an actual path between 
the same two points as measured in the real world. 
3. Location of Model Optimal Path versus Location of Real-World Optimal Path 
A model optimal path could still be a valuable representation of a real-world optimal path despite a 
larger cost than the true optimal cost if its qualitative behavior was similar enough to the path it represented. 
But algorithms may produce solutions which follow quite different routes than the real-world optimal path. 
As discussed by Mitchell and Kiersey [Ref. 19], the grid-based model upon which wavefront propagation (see 
Section E below) is based allows for multiple paths with the model optimal cost, so only the details of the al- 
gorithm implementation determine which one is reported as the solution, and that reported solution may dif- 
fer markedly from the true optimal path. This type of error may or may not be important depending on the 


application to which the results will be applied. 


E. RELEVANT OPTIMAL-PATH PLANNING RESEARCH 

A taxonomy for categorizing free-space path-planning methods is presented in Figure 6. Algorithms for 
free-space path planning generally transform an infinite search space into a finite one by eliminating all but a 
finite number of candidate paths, and then searching this finite space using standard techniques such as branch- 
and-bound or A* search. Two distinct ways used to effect this transformation to a finite search space are map 


discretization and spatial reasoning. 
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1. Map Discretization - Wavefront Propagation 

Map discretization methods approximate the terrain by imposing a tesselation on the map and 
categorizing each cell according to the terrain it overlays, and allow travel only between centers of grid cells. 
Alternate representations are possible, for example, where travel is allowed between comers of cells. Since 
there are a finite number of cells, there are a finite, though large, number of candidate paths (assuming cycling 
is prevented). A method popular for its simplicity is called wavefront propagation (see Figure 7) (Ref. 15], 
[Ref. 20]. The terrain is approximated by a square tesselation of the map, and paths are approximated by al- 
lowing motion only from the center of a cell to the center of an adjacent cell. Eight-neighbor adjacency is 
usually used, meaning that from a cell, the agent may move to any of the four perpendicularly adjacent cells 
or to any of the four diagonally adjacent cells. Because of the restrictions on directions of movement, eight- 
neighbor wavefront propagation has as much as 7.6% inaccuracy in that a reported solution may cost as much 
as 7.6% more than the real-world optimal path [Ref. 20]. Normally Dijkstra’s algorithm (branch-and-bound 
search) is used to expand in all directions from the start point until the goal is first reached. The name wavefront 
propagation is used because of the analogy of the expansion of a circular wave in water. 

The implementation of wavefront propagation reported by Richbourg [Ref. 21] ts a variation of 
Dijkstra’s algorithm which models the expansion of the wavefront explicitly. The basic mechanism is that time 
is incremented in fixed units, and at each time increment the wavefront is propagated outward as far as it can 
travel through each cell currently on the wavefront. Each cell which is reached by the wavefront is added to 
the wavefront list, and when the cell's cost has been decremented below zero it is dropped off the wavefront 
list. During each iteration, cells through which the wavefront has fully passed will propagate the wave to each 
of their neighbors. If the neighbor cell has not yet been reached by the wavefront a back-pointer is set back to 
the cell on the wavefront and the neighbor cell’s cost is decremented according to how far the wavefront can 
travel through it in a unit of time. If the neighbor cell has already been reached by another cell on the wavefront, 
no action will be taken unless the neighbor cell's cost could be decremented further by the currently propagat- 
ing cell than it was decremented by the previous cell. In that case, the pointer is changed to point to the cur- 


rent cell and the cost is set accordingly. 
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Wavefront Propagation 


If cells are square and have unit dimensions, time could be advanced in increments such that it would 
take 1 time unit for the wave to pass through a cell of unit cost in an orthogonal direction and V2 time units 
in a diagonal direction. For a cell with a cost of c, the wave will take c and c-V 2 time units respectively. Al- 
ternately, we will adopt the convention that time is incremented in units of V2, so that the wave will progress 
V2/c units of distance through a cell of cost c in the orthogonal direction in one iteration, and 1/c distance in 
the diagonal direction in one iteration. This convention provides that, for cells of integral cost, diagonal ex- 
pansion of the wave will always end inside the cell or at its edge, never overflowing into the next cell, so it is 
only in the orthogonal direction that it is necessary to check for overflow. Thus we decrement the original cost 
associated with a cell by 1 or by V2 at each iteration, and when the remaining cost is less than zero, we know 
that the wave has passed completely through it. Figure 7 illustrates the mechanics of the wavefront propaga- 
tion algorithm. The figure shows a sequence of snapshots of the algorithm, where the remaining cost of each 
cell is noted inside the cell, and arrows represent pointers to each parent cell. The arrows are solid when the 
cell has been added to the wavefront, and dotted when the cell is not yet on the wavefront but has a back- 
pointer assigned. 

For a map of m cells, the worst-case time complexity of Dijkstra’s algorithm is O(m log m), [Ref. 
15], or if we consider the two-dimensional nature of the input map, say of size n by n cells, the complexity is 
O(n? log n). This version does not depend on the costs of cells on the map. But for the version used by Rich- 
bourg, time complexity is also a function of initial costs of the cells. Each cell will remain on the wavefront 
until its initial cost c is decremented below zero. The cell’s cost will be decremented by 1 or Va at each 
iteration, so each cell will remain on the wavefront for O(c) iterations. Each iteration that a cell is on the 
wavefront, its eight neighbors will be checked to see if the shortest path yet to the neighbor cell is through the 
cell being considered, or through some already-processed cell. Thus in the worst-case where all cells have a 
COSt Cmax, if we assume that there is some upper bound on the cost of cells, the worst-case time complexity is 
O(Cmax m). In terms of an n by ninput map, the worst-case time complexity is O(Cmax n^). We must for theoreti- 
cal reasons make the assumption that there is an upper bound on the magnitude of Cmax, because if Cmax iS un- 
bounded, and as usual is represented in log cmax bits, we have that the size of the input map is I = O(log Cmax), 
or 2! 2 Cmax. Thus the worst-case time complexity would be O(2!m). As explained in [Ref. 22], this type of al- 


gorithm has pseudo-polynomial time complexity, i.e., it is polynomial if the input size is bounded, but ex- 
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ponential if the input size is allowed to be unbounded. Both versions of wavefront propagation have space 
complexity of O(m). 

Dijkstra’s algorithm examines paths in all directions from the start point, regardless of which are like- 
ly to lead to the goal point quickest. But extending the algorithm to A* search by introducing an evaluation 
function gives large increases in execution speed by focusing the search on paths which seem to be proceed- 
ing in the best directions. The evaluation function used in the A* version of wavefront propagation measures 
the Euclidean distance from the cell currently being considered to the goal cell. Mitchell and Kiersey [Ref. 
19] report an increase in speed for A* search over Dijkstra’s algorithm of 1.5 to 20 times. 

Increased resolution of the tesselation will not reduce the worst-case inaccuracy of reported solutions 
below the 7.6% upper bound. This inaccuracy, called digitization bias, arises because of the discrete ap- 
proximation of paths. The only way to reduce the upper bound on error caused by digitization bias is to in- 
crease the number of possible directions the mobile agent is allowed to travel. Sixteen-neighbor wavefront 
propagation, for example, allows paths between a cell and the sixteen cells which are separated from it by one 
cell. Richbourg [Ref. 20] showed how sixteen-neighbor adjacency could decrease the inaccuracy to ap- 
proximately 1.9%. 

Not only does digitization bias lead to inaccuracy, it also means that multiple solution paths could be 
reported depending on implementation details of the algorithm. Path representations approximate the true Op- 
timal path in the actual terrain by connected line segments which lie in allowed directions. So a true optimal 
path which for example lies at a 22.5? angle with the horizontal could be represented by one which starts in a 
45? direction, and then finishes in a horizontal direction, or it could be represented by one which alternates 
many times between small 45? line segments and horizontal line segments, somewhat like computer graphics 
routines represent lines with sets of pixels. The latter representation is to be preferred because it more close- 
ly approximates the true optimal path, and some researchers have proposed ways to augment wavefront 
propagation algorithms to favor paths which have more regular turns, so as to better approximate line seg- 
ments. [Ref. 19], (Ref. 20], [Ref. 23], [Ref. 24], [Ref. 25] 

Mitchell and Kiersey [Ref. 19] discuss an implementation of wavefront propagation called BITPATH 
which partially compensates for digitization bias by modifying the way in which path distances are computed. 


Vossepoel and Smeulders [Ref. 26] developed an estimate for the actual distance over a true optimal path given 
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a digitized approximation which lowers the estimate each time the approximation path tums, based on the idea 
that each tum point suggests overestimation of Euclidean distance. BITPATH incorporates this estimate as 
the cost function of A*, 1.e., the value assigned to a cell to represent the cost of the best path from the start cell. 
They claim a significant improvement in BITPATH's ability to find a solution which not only has minimum 
cost of all possible paths, but also lies close to the true optimal path. [Ref. 19] 

In an attempt to reduce the dependency of accuracy on resolution, data representation schemes that 
use multiple resolutions have been introduced which use hierarchical algorithms which are generalizations of 
wavefront propagation [Ref. 27]. One such scheme uses quad-trees to represent larger homogeneous areas 
with single cells [Ref. 28]. With this approach, rectangles are inscribed within homogeneous-cost regions of 
the input map, and then successively smaller rectangles fill out the shape of the regions. This representation 
is then searched much the same as in wavefront propagation. 

A parallel processing approach to wavefront-propa gation path planning has been implemented in sup- 
port of the DARPA-sponsored autonomous land vehicle built by Martin Marietta (Ref. 29]. Multiple proces- 
sors are utilized to sweep horizontal bands of the map, at each cell replacing the current cost of its neighbors 
if the current cost of the cell plus the cost to move to the neighbor is less than the neighbor’s current cost. Mul- 
tiple sweeps are employed until the cost values stabilize. Richbourg [Ref. 20] suggests an alternative based on 
mesh-connected architectures in which computational elements in the architecture would model cells in the 
map, yielding an O(n) algorithm, and Jorgenson [Ref. 30] presents a wavefront propagation implementation 
on a neural-network machine. 

2. Spatial Reasoning Methods 

Spatial reasoning uses principles about how optimal paths must behave in the presence of terrain fea- 
tures to constrain the search space for optimal paths. A simple example of this type of reasoning is that op- 
timal paths are always straight lines across homogeneous terrain, and in the case of binary terrain (obstacles 
on a homogeneous-cost background), turn only at obstacle vertices (see Theorem I-2, Appendix A). A more 
general type of discretization than that used by wavefront propagation takes place when terrain features are 
modelled using polygons. Here, error in model optimal paths versus real-world optimal paths can be much 


less than with rectangular tesselations, but since algorithms which use this type of discretization have com- 


34 


plexities which depend on the number of terrain-feature vertices in the map, there is a trade-off between ac- 
curacy of representation and speed of execution. 

Path-planning methods have used at least four distinct techniques which can be considered spatial reason- 
ing techniques, with many algorithms appealing to more than one of the techniques. They are visibility-graph 
methods, the Snell’s Law local optimization criterion, the continuous-Dijkstra paradigm, and methods using 
optimal-path maps. 

a. Visibility Graphs 

Visibility-Graph methods [Ref. 1] solve the polygonal obstacle-avoidance shortest-path problem 
(binary terrain), constructing a graph where each of the n obstacle vertices plus the start and goal points are 
nodes, and undirected arcs connect nodes whose vertices are intervisible, 1.e., can be connected by a line seg- 
ment which does not intersect any obstacle edge. Because of the spatial reasoning principle about binary ter- 
rain stated above, it is Teel that every segment of an optimal path will occur in the visibility graph, so to 
find an optimal path it is sufficient to search the graph using branch-and- bound search. 

Several algorithms have been given to construct the visibility graph. The naive algorithm checks 
every pair of vertices against every edge to see if the line segment connecting them intersects the edge. Since 
there are O(n’) pairs of vertices and O(n) edges, this brute force algorithm has worst-case time complexity 
O(n’). Lee [Ref. 31] and Mitchell [Ref. 32] explain an O(n? log n) algorithm which begins by constructing for 
each vertex a list of the other vertices sorted according to the heading of tbe line between them in O(n? log n) 
time, and then foreach of the n sorted sets, doing an angular sweep checking for intersection against the closest 
obstacle edge. Welz! [Ref. 33] and Asano [Ref. 34] used the fact that n sorts can be done in O(n’) time to build 
an O(n’) visibility graph construction algorithm. Ghosh and Mount [Ref. 35] give an algorithm to compute 
the visibility graph of n disjoint line segments in time O(e + n log n), where e is the number of edges in the 
visibility graph (an output-sensitive complexity). Since e may be as small as n or as large as n^, this al gorithm's 
worst-case time complexity ranges from O(n log n) to O(n’) depending on the size of the visibility graph. 

Once the visibility graph has been constructed, Dijkstra’s algorithm or the special case of it called 
A* (see Section A), may be used to search for the shortest path from the start to the goal. The worst-case time 
complexity of Dijkstra's algorithm is given by Aho, Hopcroft, and Ullman as O(e log n) [Ref. 36]. Again, be- 


l * - 2 
cause of the range of e, this means that Dijkstra’s algorithm is, in the worst case, O(n" log n), or with a sparse 
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visibility graph, O(n log n). A*, an "informed" version of Dijkstra's algorithm, has time complexity of the 
same order class in the worst case [Ref. 15], although actual implementations should show a significant em- 
pirical superiority of A*. Thus, the shortest-path problem can be solved by a visibility-graph approach in O(n? 
log n) time. 

For the variation of the weighted-re gion problem (or generalization of the shortest-path problem) 
given by Rowe [Ref. 2] which considers roads and rivers as well as obstacles, a visibility-graph-influenced 
approach is used to transform the search space to a finite one. Reasoning about how optimal paths must be- 
have in the presence of roads and rivers leads to the conclusions that a path will enter or leave a road at only 
one critical angle, and that paths either cross a river without changing heading, or go around river-end vertices 
as they would an obstacle vertex. A visibility graph is constructed using as nodes all obstacle and river ver- 
tices and start and goal points; roads and rivers are not considered to obscure visibility. Additionally, line seg- 
ments from each node are constructed which intersect each road at the critical angle. If the points are otherwise 
visible, the road-intersection point is added as a node and the graph reflects that the points are connected. Fur- 
ther, all nodes which lie on contiguous road segments are connected. This graph is then searched using 
Dijkstra’s or A* algorithms as above. Figure 8 shows the edges of an example generalized visibility graph. In 
this figure, solid lines represent roads, dotted lines represent rivers, and filled polygons represent obstacles. 
Narrow dashed lines represent V-graph edges and the thick dashed line represents the optimal path from start 
to goal points. Similar results for linear features are reported by Gewali et al. [Ref. 37] 

b. Snell's Law Local Optimality Criterion 

Optimal paths in the weighted-region domain obey an analogy to Snell's Law of Refraction in 
optics [Ref. 20], [Ref. 3], [Ref 38]. Snell's Law is based on Fermat's Principle which says that light seeks the 
path of minimum time. Fermat’s Principle has an analogy in the weighted-region problem, since time is a cost 
proportional to distance travelled in a homogeneous-index region. Thus optimal paths follow Snell's Law. 


Snell's Law for Optimal Paths: An optimal path passing through an edge between two regions 
with costs-per-unit-distance c1 and c2 obeys the relationship c; sin O1 — c2 sin 02, where 01 and 0 
are the angles of incidence and refraction respectively, 1.e., the angle from the path in the first region 
to a line normal to the edge, and the angle from the path in the second region to a line normal to the 
edge. (See Figure 9.) 
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Figure 9 
Snell's Law for Optimal Paths 


Note that Snell’s Law is a criterion for local, not global, optimality; a non-optimal path may obey Snell’s Law 
at each edge crossing. Therefore, its usefulness is in constructing candidates for global optimality. 

The analogy to Snell’s Law applies to crossings with an angle of incidence and refraction such 
that 01 and 02 are both less than or equal to 90%. In the path-planning domain optimal paths cannot occur 
that have angles of incidence greater tban a critical angle which is Q. = sin’! ci/cj, where ci < cj and cjis the 
cost of the region on the incidence side of the edge. For example, in Figure 10 an optimal path may go from 
point S to any point to the left of point A, but may not go immediately to its night, because the angle 0 that 
line AB would form with edge PQ of the high-cost region would exceed Oc. This is called total internal 
reflection, in optics. Another example of such behavior is found in Figure 11, where a path SABG follows 
Snell’s Law making an angle exactly the critical angle at point A and then at B. 

In Figure 12, paths just to the left of SV will be refracted according to Snell’s Law as is path 
SVA, while paths just to the right of SV will be refracted as is path SVB, but paths which go through point V 
may lie anywhere within the wedge formed by AVB. If we consider that the edges which meet at point V are 
actually continuously curved there, Snell’s Law will apply as the local curvature increases to infinity. The 
same behavior happens in Figure 13, at vertex V of an obstacle. 

Finding an exact Snell’s-Law path between two points through a sequence of edges requires an 
iterative search. Richbourg [Ref. 20] and Mitchell [Ref. 15] both discuss the lack of a closed-form solution for 
the problem of finding the Snell’s-Law path between two points. But since it is an easy task to trace a Snell’s- 
Law path from a point with a given heading, both conclude that an iterative search is the best approach. Rich- 
bourg studies the effectiveness of four techniques for finding, to within a given error, a Snell's-Law path across 
one edge. He used experiments applied to bisection search, golden-section search, false-position search, and 
a modification called heuristic false-position search, and found that the latter converged more than twice as 
fast as any of the others on the average, and also had the least standard deviation of the four methods. His 
heuristic false-position method attempts to avoid the situation where the search approaches the solution from 
the same side at each iteration, since false-position tends to converge more quickly when the solution is brack- 
eted. 

Mitchell's algorithm uses a numerical routine to approximate the Snell's-Law path across n edges 


which is of a time complexity that he calculates is bounded by O(n*L), where L is a measure of the precision 
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Figure 10 
Snell’s Law Example 1 
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Figure 12 


Snell’s Law Example 3 
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Figure 13 


Snell's Law Example 4 


43 


of the problem instance. This routine ts used because of its proven worst-case speed, but he also reports a coor- 
dinate descent method for solving a Snell's-Law path across several edges which is said to have fast empiri- 
cal convergence. This method uses as a starting path a sequence of line segments between start and goal points 
through the midpoint of each edge. It then successively adjusts each crossing point in constant time to satisfy 
Snell’s Law with respect to its two neighbor crossing points, iteratively applying these adjustments until the 
path is within a specified error of the goal. 

c. Continuous-Dijkstra Paradigm 

Path-planning methods for the weighted-region problem have used one of two similar ap- 
proaches, both relying on Snell's Law and related properties as discussed above. Mitchell's algorithm uses 
wliat he calls the continuous-Dijkstra paradigm, because of its analogy to the discrete Dijkstra algorithm [Ref. 
3], while Richbourg’s algorithm uses recursive wedge decomposition [Ref. 20], [Ref. 21]. Whereas Dijkstra’s 
algorithm must be used over terrain approximated by map discretization, the continuous- Dijkstra and the recur- 
sive-wedge-decomposition paradigms are used over terrain in which terrain features are represented by 
polygons or piecewise-linear curves. 

The continuous-Dijkstra paradigm, analogously to searching a finite graph for the next closest 
node in Dijkstra’s algorithm, searches in a concentric plane sweep outward from the start point, processing 
each terrain-feature vertex as the sweep reaches it. The algorithm requires the triangulation of the terrain map, 
a task for which standard algorithms are available from computational geometry. Each vertex has associated 
with it a label which represents the cost of tbe best path yet found to it, just as in the discrete Dijkstra algo- 
rithm. Additional points, called frontier points, also have labels associated with them. They are points in the 
interior of an edge at which critical reflection occurs (see above). 

The key data structures for Mitchell's algorithm are first, a list of subsegments of terrain-feature 
edges called candidate intervals of optimality, and second, a priority queue called the event queue after the 
terminology used in the plane sweep paradigm. Candidate intervals of optimality are the extent of an edge over 
which an optimal path could possibly lie by the constraints of Snell’s Law. Intervals include information about 
the root, or last previous vertex through which the all optimal paths which cross the interval lie, and about the 
paths from this root to either end of the subse gment interval. The event queue contains those points which are 


end points of some candidate interval, or are frontier points in the interior of an interval. 


At each step of the algorithm, the point on the event queue with the smallest cumulative cost 
from the start point is chosen. If it is a frontier point, then the candidate interval is said to propagate. In other 
words, more candidate intervals on other edges are found each of which includes an edge subse gment to which 
optimal paths could arrive through the initial interval. The appropriate points have their costs computed and 
are added to the event queue. When the event queue becomes empty, the algorithm terminates, and the goal 
point has been labelled with its optimal cost. The list of candidate intervals holds, at any point in tbe algorithm, 
the best path or set of paths so far from the start point to the interval, so the interval which is the goal point is 
found in order to retrieve the optimal path. This algorithm has at most O(n") event points, and uses the O(n*L) 
routine discussed above to find a Snell's-Law path between two points, and so has a worst-case time com- 
plexity of O(n’L), where nis the number of terrain-feature vertices and L is a measure of the precision of the 
problem instance. 

Richbourg’s algorithm uses A* search to select a group of paths for refinement which offers the 
best hope of containing the optimal path from the start point to tbe goal [Ref. 20). As refined Rowe and Rich- 
bourg [Ref. 39], a well-behaved path subspace (WBPS) is defined as a set of paths which cross the same ter- 
rain- feature edges and vertices from the start to the goal. À wedge is a partial WBPS which is a set of paths 
crossing the same edges and vertices from the start point to some intermediate point or edge. Refining a wedge 
means finding within the wedge the nearest intermediate point which has not yet been considered, finding a 
Snell’s-Law path to that point, and splitting the wedge into three sub-wedges based on the cases which arise 
from Snell’s Law. These three wedges are added back to the A* agenda for further consideration. Two of the 
three wedges are those consisting of paths which pass to the "left" and "right” of the point at which splitting 
occurs, while the iniddle wedge is constructed based on the possible behavior of paths emanating from the 
point. The tenn recursive wedge decomposition refers to the successive splitting of wedges as they are selected 
from the A* agenda and refined. 

The search space for recursive wedge decomposition 1s a known feasible start-to-goal path and 
a set of wedges with associated lower-bound values of cost function plus evaluation function for each wedge. 
These lower-bound values represent the lowest possible cost for a path within the wedge. The known feasible 
path is replaced whenever a better path is found, so that it is always the best known path. The single operator 


for state transformation is wedge refinement. The algorithm uses a different termination criterion than that 


normally used by A* in path-planning applications. Normally the search can stop when the first element on 
the agenda is a complete solution, because the agenda is ordered by increasing cost-function plus evaluation- 
function values, and for a complete path the evaluation function equals zero and the cost function is the ac- 
tual cost from start to goal. However, in this search space, the elements on the agenda are wedges, not paths. 
The search terminates when the best wedge on the agenda (and hence all other wedges on the agenda as well) 
has a cost-function plus evaluation-function value that exceeds the upper-bound cost of the current best feasible 
known path, or when the agenda is empty. In either case the least-cost known path is the solution. Wedges are 
pruned, or removed from the search space, according to a set of criteria based on Snell’s Law and other spa- 
tial reasoning. An implementation of Richbourg’s recursive-wedge-decomposition algorithm is reported to 
have empirical performance which strongly suggests an O(n’) average-case time complexity, where n is the 
number of terrain-feature vertices. Worst-case time complexity was reported to be O(n!n^) [Ref. 39]. 

The two algorithms are quite similar in some respects. The candidate interval of the continuous- 
Dijkstra algorithm along with its associated data about boundary paths corresponds to the wedges of the recur- 
sive-wedge-decomposition algorithm, and propagation of intervals corresponds to refinement of wedges. The 
same properties of Snell's Law refraction and critical reflection are used in determining how to refine wedges 
(propagate intervals). However, there are differences of emphasis. The focus of the continuous-Dijkstra algo- 
rithm seems to be finding a polynomial-time worst-case algorithm, while the A* search of the recursive-wedge- 
decomposition algorithm focuses on average-case performance. The continuous-Dijkstra algorithm requires 
a triangulation of the input map, a time-consuming preprocessing step which nevertheless does not raise the 
worst-case time order of complexity, while the recursive-wedge-decomposition algorithm takes as input a map 
of polygonal terrain features. The recursive-wedge-decomposition implementation reported in [Ref. 21] was 
used in our research for initialization in our Chapter VI algorithms. 

A generalization of the weighted-region problem allows anisotropic costs in regions, that is, costs 
which are a function of the direction of travel of the mobile agent, for example, in steeply sloped terrain. Ross 
[Ref. 40] solves the anisotropic weighted-region problem using a variation of recursive-wedge decomposition. 
Based on the effects of gravity, friction, and maximum force which can be applied by the agent, there are 
several sets of impermissible headings which may constrain travel across a polygonal region. A range of uphill 


headings may be ruled out by maximum force available, loss of traction, or catastrophic overtum, and a range 
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of sideslope headings may be ruled out by catastrophic overturn considerations. Additional optimality con- 
siderations include a range of downhill braking beadings within which the agent must lose energy by braking, 
and Snell's Law for optimal paths as described above. Given these constraints, there are only four ways an op- 
timal path can cross an anisotropic region. This insight leads to an algorithm which recursively decomposes 
groups of potentially optimal patbs according to which terrain-feature vertices and edges they cross (window 
sequences), and applies A* search to these groups of paths, using various pruning criteria to limit the search 
space. 
d. Optimal-Path Maps 

Several researchers have used optimal-path maps (OPM), or as they are commonly called with 
respect to binary terrain, shortest-path maps, as a means of solving the shortest-path, binary-terrain problem. 
Lee and Preparata [Ref. 41] give an O(n log n) algorithm to construct an OPM for the special case that all 
obstacles are parallel line segments, and Reif and Storer (Ref. 42] give an O(mn + n log n) algorithm, where 
m is the number of obstacles and n is the number of obstacle vertices. Mitchell [Ref. 4] gives an O(kn log? n) 
algorithm for the general case, where k is an output-sensitive parameter somewhat related to tbe density of 
obstacles in the plane. 

The algorithm of Lee and Preparata uses the plane sweep paradigm and constructs both the op- 
timal-path tree and the planar partition with one sweep of the plane. Assuming without loss of generality S 
the parallel line-segment obstacles are vertical and the start point is to the left of all obstacles, the sweep line 
is also vertical and begins at the start point. The obstacles are indexed by their x-coordinates, and the initial 
event queue contains the x-coordinates of each obstacle. As the sweep line encounters an obstacle, it locates 
the two endpoints in regions of the OPM so far constructed and extends the optimal-path tree by inserting a 
node for each obstacle endpoint into the tree at the node associated with these regions. Then it constructs the 
three bisectors, or homogeneous-behavior region boundaries, which begin at the obstacle, two of which are 
rays and one of which is a hyperbola segment. It updates a list of "active" bisectors by deleting previously- 
found bisectors which intersect the current obstacle, and adds the new bisectors to the list. Then it updates the 
event queue by inserting points of intersection of the new bisectors with any other bisectors. Only the left- 
most such intersection must be recorded. At each stage, the OPM is updated wlien both endpoints of a bisec- 


tor are found. [Ref. 41] 
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The algorithm due to Reif and Storer takes as input a tnangulation of the obstacle edges, and 
recursively processes these triangles to find shortest paths from the start point to each vertex of the triangula- 
tion. The algorithm "grows" outward from the start point, constructing a partition of the plane. The discussion 
of this algorithm in Reference 42 is somewhat obscure, as it does not use the terminology of shortest-path 
maps, and depends on other algorithms and data structures not fully explained in Reference 42. 

A solution to the optimal-path-map problem which takes a different approach is presented by 
Payton [Ref. 43]. It is built on the wavefront propagation algorithm, and consists of storing the back-pointers 
for each cell. This array of pointers is called a gradient field, and provides information about which direction 
a mobile agent should go from any point on the map in order to travel along an optimal path. This approach 
could be used with other point-to-point path planners as well, although with greatly increased preprocessing 
time, by simply running the path planner for a finely-grained array of start points, and storing the inittal direc- 
tion of the resulting optimal path for each run. 

Mitchell’s algorithm introduces the concept of "generalized visibility" within the obstacle space, 
and constructs shortest-path maps for each new level of visibility. This algorithm begins by computing the 
visibility polygon from the start point, i.e., the polygon containing all points in the map which are not occluded 
from the start point by an obstacle edge. Then it appeals to the algorithm for constructing generalized Voronoi 
diagrams within simple polygons due to Aronov [Ref. 13] which takes into account that boundaries may be 
hyperbolic or linear, depending on the costs of optimal paths from obstacle vertices. Using this generalized- 
Voronoi-diagram concept, Mitchell’ s approach constructs a shortest-path map for the visibility polygon. Then, 
the algorithm computes the second level of visibility, that is, extends the visibility polygon to include all points 
visible from any part of the initial visibility polygon. Again, it reduces the problem of extending the shortest- 
path map to the problem of defining appropriate Voronoi-diagram problems on simple polygons. This process 
continues iteratively until all obstacles have been found by the generalized visibility process. [Ref. 4] 

So essentially, Mitchell’s algorithm is doing a concentric plane sweep (although not using this 
terminology), where at each iteration, the next generalized visibility polygon is found, a Voronoi diagram is 
constructed for the obstacles in the polygon, and these Voronoi diagrams are merged with the Voronoi diagram 
from the previous iterations. The computation of visibility polygons does use the plane sweep paradigm ex- 


plicitly, sweeping a "geodesic" (or optimal) path angularly about the start point. In order to deal with several 
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cases in which a single sweep would not correctly identify all the event points, two sweeps, one in each direc- 
tion about the start point, are done to compute each visibility polygon. This algorithm operates in O(n log^n) 
worst-case time, where n is the number of obstacle vertices in the input map. [Ref. 4] 

The focus of this dissertation 1s on the construction of a planar partition for the weighted-region 
problem. In keeping with the convention discussed above of referring to solutions to the weighted-region 
problem as optimal paths instead of shortest paths, we refer to such a partition as an optimal-path map. Mitchell 
[Ref. 15], claims to have constructed an optimal-path map for the weighted-region problem, but does not men- 
tion the task of constructing region boundaries. His algorithm appears to construct, instead, an optimal-path 
tree, a necessary and time-consuming first step in constructing an optimal-path map, but gives little attention 
to construction of the planar partition. This confusion may arise from the fact that in the binary-terrain domain, 
construction of region boundaries is straightforward, a fairly insignificant part of the total problem, while the 
added complexity of the Ec: problem creates additional complexities in the characterization of 
boundaries and the construction of the optimal-path map. In binary terrain, the standard Voronoi-diagram 
methods which construct straight-line bisectors only need to be extended to construct hyperbola segments as 
well, while in weighted-region terrain, such bisectors take on many different forms. Thus the problem of "defin- 
ing the appropriate Voronoi-diagram problem", as Mitchell does in the binary case, is a much more difficult 


one. 
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III. MODIFYING WAVEFRONT PROPAGATION TO FIND SUB-OPTIMAL 
SOLUTIONS TO THE OPTIMAL-PATH-MAP PROBLEM 


A. OVERVIEW 

Wavefront propagation is well-suited as a method for solving the fixed-goal optimal-path-map problem 
(see Chapter II, Section C for a complete description of this problem), if the inherent error is acceptable in tbe 
application domain. The basic wavefront propagation algorithm can easily be extended by considering, for 
each cell on the wavefront, whether there should be a boundary between it and its adjacent cells, using one of 
the three definitions of "similar behavior”. What for tbe point-to-point problem was a disadvantage of 
wavefront propagation, that the algorithm in its basic form searched blindly in all directions without regard to 
the location of the goal, becomes an advantage for the optimal-path-map problem because the paths from each 
cell in the map are available as a by-product of the algorithm simply by tracing the back pointers. Another ad- 
vantage is that the asymptotic worst-case time complexity of the extension is the same as the basic algorithm. 

In chapter II the path-generalizing function was defined in terms of "similar behavior" of paths. In this 
chapter we solidify the meaning of "similar behavior" to group paths in three different ways that make sense 
for wavefront propagation, thus defining the path-generalizing function in three ways. The first way produces 
boundaries between adjacent cells whose goal paths turn at cells which are not "equivalent". The second way 
uses a set of heuristics to group cells whose goal paths converge. The third way groups cells according to 
whether their paths turn at the same terrain-feature vertices and edges. 

It might be possible to bypass the need for an optimal-path map altogether by simply storing back pointers 
for every cell in the map (for example, in the work of Payton discussed in Chapter II [Ref. 43], such a database 
of pointers is called a gradient field). Given a start cell’s coordinates, the path to the goal could be reconstructed 
by following the pointers back to the goal cell. There are two disadvantages to this method. First, the average- 
case time complexity to reconstruct a backpath is O(n), for an input map of size n by n. Second, the storage 


requirement for the optimal-path map is O(n? ). To avoid these problems, we store an optimal-path map. 
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B. MODIFYING THE PATH-GENERALIZING FUNCTION FOR WAVEFRONT 
PROPAGATION OPTIMAL-PATH-MAP CONSTRUCTION 
1. The Pure Version of Wavefront-Propagation Optimal-Path-Map Construction 

The most natural description of a path 1s the list of all cells from start point to goal point. Requiring 
two such path lists to be identical in order to represent "similar behavior” would result in every cell in the map 
compnising its own homogeneous-behavior region. But it is unnecessary to include all cells in a path segment 
which lie in on the same straight line. So another definition of a path list is the list of cells at which the op- 
timal path tums, or more precisely, the cells in the backpath of a start point for which each back-pointer of the 
cell is in a different direction than the back-pointer of the cell’s parent. 

This definition still induces many distinct regions. A modification is to specify that two turn-point 
cells on different backpaths are considered equivalent if one of them lies on the first leg of the optimal-path 
list which starts at the other tum-point. Thus, for example, the two cells (5,3) and (6,2) in Figure 7 would have 
optimal-path lists [(5,5),(7,7)] and [(6,6),(7,7)] respectively; cells (5,5) and (6,6) would be considered 
equivalent because the optimal-path list of cell (5,5) 1s [(7,7)] and (6,6) lies on the line between (5,5) and (7,7); 
so cells (5,3) and (6,2) lie in the same region. 

We call the version of the wavefront propagaton optimal-path-map algorithm which uses this defini- 
tion of the path-generalizing function the pure version, since it is based on a simple definition of homogeneous- 
behavior regions. Changes to the basic wavefront propagation algorithm in Appendix B necessary to impleinent 
this are presented in Table 1 below (two pages). The key change is a check for boundaries between each cell 
on the wavefront and its four neighbors. This is accomplished in procedure expand-cell which is executed 
once for each cell on the current wavefront. Procedure expand-cell calls procedure check-for-boundaries 
which compares the path lists of each of the cell's neighbors wiih the expanding cell's path list. checking for 
"equivalency" as defined above. Whenever a new cell is added to the wavefront, its path list is set by proce- 
dure set-optimal-path-list whicliis called from within orthogonal-expand, diagonal-expand, and overflow. 
These procedures, although not shown here, are modified from the versions shown in Appendix B by adding 
a call to set-optimal-path-list after each new cell is added to the wavefront list or the overflow hist. When the 


procedure check-equivalent-paths called by check-for-boundaries determines that two path lists are not 
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TABLE 1 
WAVEFRONT-PROPAGATION OPM ALGORITHM 


algorithm wavefront-propagation-opm (Algorithm ITI-1) 
input: Goal-Point /* REVISED from algorithm B-1 */ 
| /* in Appendix B. */ 


Wavefront :2 Goal-Point; 
Boundary-List := empty list; 


while (Wavefront not empty) /* Iteratively expand wavefront */ 
expand-wavefront( Wavefront); /* until nothing remains on it. */ 
} /* end of wavefront-propagation-opm */. 
procedure expand-wavefront /* REVISED PROCEDURE */ 


input: Wavefront 

if (Wavefront is empty) /* Base case of the recursion. */ 
Cells-for-New- Wavefront := empty list; 
New- Wavefront := empty list: 

else 
| 
Current-Cell := cell on Wavefront with min remaining cost; 
expand-cell(Current-Cell); 
Rest-of-Wavefront := Wavefront less Current-Cell; 


expand-wavefront(Rest-of-Wavefront); /* recursive call to expand-wavefront */ 
New- Wavefront := Cells-for-New-Wavefront /* Note: Wavefront is recursively emptied */ 
appended onto front of New- Wavefront; /* out level by level and New- Wavefront */ 
) /* is built up as each level returns. */ 
| /* end of expand-wavefront */ 
procedure expand-cell /* REVISED PROCEDURE */ 
input: Current Cell 
{ /* initialize flag assuming that Current-Cell */ 
Finished-With-Cell := TRUE; /* will not stay on Wavefront */ 
check-for-boundaries(Current-Cell); /* ADDED TO THIS VERSION */ 


Boundary-List :z New-Boundary-List appended /* ADDED TO THIS VERSION */ 
to Boundary- List: 

Cells-for-New-Wavefront := empty list; 

for (New-Cell := North-, East-, South-, and West-Neighbor) 
orthogonal-expand(Current-Cell,New-Cell); 

for (New-Cell := Northeast-, Southeast-, Southwest-, and Northwest-Neighbor) 
diagonal-expand(Current-Cell,New-Cell): 


if not (Finished- With-Cell) /* keep Current-Cell on Wavefront */ 
Cells-for-New- Wavefront := Current-Cell appended 
onto Cells-for-New- Wavefront; /* CHECK FOR GOAL DELETED */ 
} /* end of expand-cell */ 
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TABLE 1 (CONTINUED) 
WAVEFRONT-PROPAGATION OPM ALGORITHM 


procedure check-for-boundaries /* NEW PROCEDURE */ 
input: Current-Cell 
| 
New-Boundary-List := empty list; 
for (Neighbor-Cell :z each of 
Current-Cell's eight neighbors) 
if not (Parent-Pointer of Neighbor-Cell = nil) /* if wavefront has reached neighbor, */ 
{ /* a boundary check can be made. */ 
OPLI := OPL-Parent of Netghbor-Cell; 
OPL2 := OPL-Parent of Current-Cell; 
if not (check-equivalent-paths(OPL1,OPL2)) /* update new boundary list */ 
New-Boundary-List := edge or comer 
connecting the two cells appended to New-Boundary-List; 


} /* end of check-for-boundaries */ 
procedure set-optimal-path-list /* NEW PROCEDURE */ 
input: Cell 
{ /* NOTE: There are two parent-pointer fields in */ 
if (Parent of Cell is on line segment between /* the "Cell" array - "Parent" field is predecessor */ 
Cell and OPL-Parent of Parent of Cell) /* of Cell on the backpath: "OPL-Parent" is the */ 
OPL-Parent of Cell := OPL-Parent /* predecessor on the Optimal-Path List. */ 
of Parent of Cell; 
else 
OPL-Parent of Cell := Parent of Cell; 
) /* end of optimal-path-list */ 
procedure check-equivalent-paths /* NEW PROCEDURE */ 


input: OPLI, the OPL-Parent of Neighbor-Cell 
and OPL2, the OPL-Parent of Current-Cell 
output: returns TRUE if paths are 
equivalent, FALSE otherwise. 
| 
if ((first cell of OPL I z first cell of OPL2) /* Paths are equivalent if first */ 
or (first cell of OPL I is on the line /* pair of cells are equivalent */ 
between first and second cells of OPL2) 
or (first cell of OPL2 is on the line 
between first and second cells of OPLI) 
retum( TRUE); 
else return (FALSE): 
} /* end of check-equivalent-paths */ 
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equivalent according to the above definition, the edge which the two cells share is considered a boundary and 
is added to a list of boundaries. 

Since each cell with non-infinite cost is on the wavefront once during the algorithm, we will in the 
end check each cell on the map. For two adjacent cells, if one cell is has been reached by the wavefront and 
the other has not yet been reached, the second cell’s path list will not yet be determined, so a boundary check 
is not yet possible. But when the second cell is finally put on the wavefront, its path list is set and a check of 
its neighbors will consider the first cell. So it is guaranteed that aH pairs of neighbors will be checked by the 
end of the algorithm, and all boundaries between cells will be detected. 

Note that references to the start point have been deleted from the algorithm, since we are looking for 
paths to all start points. The initial center of the wavefront is called the goal point. Also, there is no possibility 
for the algorithm to fail because of an inability to find the start point. When no cells remain on the wavefront, 
the program is done. Then the list of boundaries will be transformed into the appropriate data structure, a doub- 
ly-connected edge list, and the path information will be transformed into an optimal-path tree. 

The procedure set-optimal-path-list will be called by procedures orthogonal-expand, diagonal-ex- 
pand, and overflow each time a new cell is appended onto the Cells-for-New-Wavefront or Overflow lists 
respectively. 

Figure 14 (on two pages) shows the result of applying the pure definition of the path-generalizing 
function to wavefront propagation, with a map consisting of a single obstacle and a single high-cost area. The 
figure shows successive snapshots over time as the wavefront expands and the back-pointers are set. The 
wavefront expands from the goal point in the center, and back pointers show the optimal path from each start 
point to the goal point. Homogeneous-behavior boundaries are shown as dotted curves. (Several horizontal 
backpaths appear darker than the others only because of the resolution of the printer used.) Figure 14a shows 
the first three snapshots, and Figure 14b shows the fourth snapshot and a final frame with backpaths removed 
for clarity. 

Several homogeneous-behavior boundaries in Figure 14 are spurious, that is, are not predicted by 
theoretical analysis. (This analysis is presented in Chapter V.) Near the upper left corner of the higli-cost area. 
for example. (see Frame 5 in Figure 14b) three straight homogeneous-behavior boundaries emanate from a 


point on the edge of the high-cost area: one is vertical. one is at a 45" angle, and one is horizontal. The latter 
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two of these boundaries do not have analogues in the theoretical case, and the first, analogous to the "shadow" 
boundary expected at that vertex, is offset from the vertex of the high-cost area does not appear. 

Some spurious boundaries are generated because straight lines are being approximated by piecewise- 
linear curves in the eight allowable propagation directions. Several examples occur to the right of the high- 
cost area and to the left of the obstacle. Multiple parallel boundaries are generated by the upper-left edge of 
the obstacle, although all but the topmost boundary are spurious, while the two lower boundaries generated 
by the lower-left edge are both predicted by the analysis of Chapter V. The reason for the difference is that 
the lower-left edge is positioned at a 45° angle to the vertical, allowing a single straight path to lie along it. 
Thus the above boundary-detection heuristic does not detect spurious boundaries along the edge because there 
are no tum points on the path. But the upper-left edge lies at less than a 45° angle with the horizontal, and so 
the path along it must "stair-step” its way to the upper vertex, causing boundaries to be generated. A similar 
error occurs along the upper right and lower right edges of the high-cost area, where the stair-step nature of 
the edges causes spurious exterior boundaries to appear. Further spurious boundaries occur in the inside of the 
high-cost area, and outside it just above its rightmost vertex. 

Optimal-path maps generated by the pure wavefront propagation OPM algorithm will be useful if 
these spurious homogeneous-behavior boundaries do not matter. But there are approximately twice as many 
boundaries as are predicted by theoretical analysis, so storage and run-time speed are correspondingly less ef- 
ficient. 

2. The Diverging-Path Version of Wavefront-Propagation Optimal-Path-Map Construction 

Another approach is based on the idea that two adjacent cells whose paths diverge should be in dif- 
ferent regions, and so a boundary must exist between them. A way of detecting divergence of paths is to check 
the distance between the mth-generation ancestors of two adjacent cells. If the ancestors more than one cell 
apart, the cells are defined as diverging paths. In other words, we define the path-generalizing function so that 
it maps cells to sets of paths which do not diverge. 

What should the value of n be? In other words. how far back along the paths of the two cells being 
compared should we check? If n is small, there will be fewer checks to perform, enhancing efficiency. 1f n is 
large some small terrain features may be overlooked by the divergence rule. On the other hand if n is large. 


we can handle situations, such as boundary emanating from the obstacle in Figure 14b. Frame 5, where back- 
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paths may parallel each other for some distance before diverging. But this situation can be taken care of by 
adding a second condition which says that two cells are in different regions if their parents are in different 
regions. Even with this rule, however, ifn = 1, there are situations where the parents of two cells with diverg- 
ing paths are adjacent; choosing n = 2 seems to give the best results. An additional necessary heuristic is that 
two paths are in different regions if a cell between the two ancestors being checked is a terrain feature cell. 
This handles special cases such as very acute obstacle vertices, or paths on opposite sides of a river. Figure 15 
(on two pages) shows the result of applying these heuristics to wavefront propagation. We call this the diverg- 
ing-path version of the wavefront-propagation OPM-generation algorithm. 

So there are three heuristics used in the diverging-path version. First, adjacent cells whose second- 
generation ancestors are more than one cell apart are in different regions. Second, adjacent cells are in dif- 
ferent regions if their parents are in different regions. Third, cells are in different regions if their 
second- generation ancestors have a terrain-feature cell between them. 

This variant algorithm is not much better than the pure variant, as can be seen by studying Figure 
15b, Frame 5. Here too few boundaries are generated, and a few spurious boundaries appear as well. Those 
boundaries defined in Chapter V as opposite-edge boundaries, i.e., boundaries which distinguish between 
paths which go in opposite directions around a terrain feature, are the ones best detected by the diverging-path 
version. Shadow boundaries, i.e., boundaries which distinguish between paths which go through a terrain-fea- 
ture vertex from those which bypass it, are not detected at all. Spurious boundaries arise within homogeneous- 
cost areas. The homogeneous-cost area in Figure 15 has spurious boundaries just above its rightmost vertex. 
But for purely binary terrain, 1.e., obstacles on a homogeneous-cost background, the diverging-path version 
may be appropriate. 

3. The Vertex-Edge Version of Wavefront-Propagation Optimal-Path-Map Construction 

Any variant algorithm that relies solely on the turns ina path will misinterpret some turns as due to 
the terrain when tn fact they were due only to the mechanics of the algorithm (e.g., the eight propagation direc- 
tions). and vice versa. Also, the diverging-path variant only detects a certain class of boundary. A way to at- 
tack both of these problems is to plot boundaries based on how terrain-features affect optimal paths. 

In terrain with piecewise-linear edges in homogeneous-cost background. optimal paths will tum only 


at terrain feature vertices or edges (Theorem 1-2, Appendix A). Thus. if a tum in a path occurs at other than a 


Ie 


| >. Obstacle 


+ Migh-Cost Arca 





BeGevneeeeeeneereeee 
ATRAS 
III AA e 
ro 
AAA AAA 
rr A 
nn II 
ar 
AAA AAA AAA AL] 


ze Optimal Paths 
= to Goal 








, Behavioral 
Boundary 





Figure [5a 


Example of Diverging-Path OPM Version of Wavefront Propagation 


E 





vertex or edge, it must be turning based on algorithm mechanics alone. So we could check whether or not a 
turn point in a path is adjacent to a terrain-feature vertex or occurs at the edge of a homogeneous-cost region. 
We could define the path-generalizing function as mapping a cell to a list of the terrain-feature vertices and 
edges at which its optimal path turns. We can say that a path turns at a vertex or edge if the turn cell is ad- 
jacent to or the same as tbe vertex or edge cell. 

This approach requires some additional terrain preprocessing. Since terrain in the two previous ver- 
sions has been represented entirely as individual cells, some way of finding and representing terrain-feature 
edges and vertices will become necessary. Such a preprocessing algorithm could group cells into terrain fea- 
tures of homogeneous cost, and then fit poly gons to each feature. For each vertex of the polygon, it could find 
the closest corresponding cell in the original representation and label it as a vertex. For each edge of tbe 
polygon, it could find which cells most closely corresponded to it and label them as lying on that edge. Wade 
[Ref. 44] presents an "om for doing such terrain preprocessing. 

So we redefine "path list" to include only vertex and edge descriptors. To do this, turn cells are check- 
ed to see if they are adjacent to a terrain-feature vertex or edge. This procedure may create a spurious bound- 
ary if a path tums twice within one cell of a vertex, a case which would happen at a comer which formed a 
very acute angle, for example, a river end. In this case, a spurious boundary would lie along the side of the 
river segment away from the start point. We must also specify from which side a path crosses an edge, m 
cause a path may leave an area across an edge and then reenter it across the same edge. This type of path is il- 
lustrated in Figure 16b, Frame 4, starting at the cell labeled A. The path from A has a path list [A,C,D,G]. 
while a path from cell B has a path list [C,D,G]. When comparing cells A and C (the first cells on the two 
paths) to determine if A and B have a boundary between them, we must be able to determine that the first path 
crosses out of the high-cost area at A, while the second path crosses into the area at C, and so the paths have 
different behavior. This set of heuristics provides the ability to detect boundaries inside homogeneous-cost 
areas, across rivers, and across roads. The procedures set-optimal-path-list and check-equivalent-paths arc 
listed in Table 2 with the appropriate changes. 

Figure 16 shows the above heuristics in operation. There is a very close correspondence between the 
boundaries of Figure 16b, Frame 5, and the theoretically correct boundaries for an exact optimal-path map. 


Few spurious boundaries are generated. For example, there are too many boundaries emanating from the far 
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TABLE 2 
WAVEFRONT-PROPAGATION OPM ALGORITHM 
CHANGES FOR VERTEX-EDGE VERSION 


procedure set-optimal-path-list /* REVISED PROCEDURE */ 
input: Cell 
| 
if (Parent of Cell is on Edge; and OPL-Parent of /* include a cell in OPL for each boundary- */ 
Parent of Cell is not on Edgei) /* crossing episode. */ 


OPL-Parent of Cell := Parent of Cell; 

else if (Parent of Cell is on line segment between /* SAME AS PREVIOUS VERSION */ 
Cell and OPL-Parent of Parent of Cell) 
OPL-Parent of Cell := OPL-Parent of Parent of Cell; 


else 
OPL-Parent of Cell := Parent of Cell: 
| /* end of optimal-path-list */ 
procedure check-equivalent-paths /* REVISED PROCEDURE */ 


input: OPLI, the OPL-Parent of Neighbor-Cell 
and OPL2, the OPL-Parent of Current-Cell e 
output: retums TRUE if paths are equivalent, FALSE otherwise. 


| 
if (OPLI = OPL2 = [goal -point]) 


retum(TRUE): 
else 
| 
fori=Ito2 
until ((first cell of OPL; is adjacent to 
a cell marked "vertex") or (first cell of /* Consider only cells which are */ 
OPL; is marked "edgej")) /* adjacent to terrain-feature vertices */ 
OPL; := OPL; less first cell; /* or represent edge-crossing episodes */ 
if ((first cell of OPLI = first cell of OPL2) /* Paths are equivalent if each */ 
or (first cell of OPLI is on the line /* pair of cells are equivalent */ 


between first and second cells of OPL2) 

or (first cell of OPL2 is on the line 
between first and second cells of OPL1) 

or ((edgej = edgej) and /* NEW CONDITION */ 
check-equivalent-paths( OPL 1 less first 
cell, OPL2 less first cell)) 

Boundary-Flag := TRUE: 

else Boundary-Flag := FALSE: 


/* end of check-equivalent-paths */ 


* 
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right vertex of the high-cost area. And few boundaries are overlooked, although some shadow boundaries do 
not appear. For example, a shadow boundary should emanate from the lower right vertex of the obstacle: in 
Chapter V we develop analytic characterizations of homogeneous-behavior boundaries and find that the linear 
boundaries incident upon vertices should act as if they were shadows with the goal acting as a point light 
source. Also, the curved boundaries on the hidden side of obstacles should be hyperbolas, and the curved boun- 
daries inside homogeneous-cost areas should have monotonic curvature. From these comments, it can be seen 
that the boundaries generated by the vertex-edge version (as well as the other versions of wavefront propaga- 


tion) have some error in location and shape, although they may suffice for many applications. 


C. RECONSTRUCTING OPTIMAL PATHS FROM WAVEFRONT PROPAGATION 
OPTIMAL-PATH MAPS 

How can we reconstruct the optimal path from the start point knowing the node of the optimal-path tree 
which descibes its behavior? The answer depends on what information is available in the nodes, which will 
be different depending on the version of wavefront propagation, because homogeneous-behavior regions are 
defined differently for each version. For the pure or diverging-path version, each optimal-path-tree node rep- 
resents a single cell. Because intermediate turn cells on the portion of a path which lies within a homogeneous- 
behavior region are a result of the mechanics of the algorithm, and not of terrain-feature influence, a path can 
be approximated by plotting straight lines from a start cell to the cell of the node representing the region in 
which the start cell lies, another straight line from that cell to its parent in the optimal-path tree, and so on back 
to the goal. This type of path no longer conforms to the grid-based model; otherwise, some "stair-step" ap- 
proximation of the line would be required. By Theorem I-2, in the type of terrain considered herein, paths are 
straight-line segments except at terrain-feature vertices oredges. So the vertex-edge version can use the above 
method for paths from start cells to nodes representing vertices, and between vertices. Between edges, further 
processing would be necessary to determine where along an edge a given path would cross using Snell's Law 


as discussed in Chapter IT. 


65 


IV. ANALYSIS OF WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 


A. SOURCES OF ERROR IN WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

A problem with using wavefront propagation to generate optimal-path maps is that the inherent error of 
the algorithm is carried forward to the OPM. As stated previously, Richbourg [Ref. 20] showed that an upper 
bound on the error factor of the cost of a model-optimal path generated by the point-to-point wavefront 
propagation algorithm compared with the cost of the corresponding real-world optimal path is cos(7t/8), or 
about 7.6%. The fact that the shapes of boundaries generated by wavefront propagation are only approxima- 
tions of the correct shapes derived in Chapter V reflects the error in the shape and cost of optimal paths in- 
herent in wavefront propagation. 

The optimal-path map in our approach does not retain information about all the intermediate cells where 
each path turns, and so we cannot reproduce the path exactly as generated by wavefront propagation. If we 
could, however, the upper bound on percent error of 7.6% would remain in effect, because nothing in the OPM 
algorithms of Chapter IH affected how the wavefront expanded from cell to cell. The backpaths of Figures 14, 
15, and 16 are all identical (compare Frame 4 of each figure), and only the boundanes differ. Although we 
cannot reconstruct a path exactly as generated by wavefront propagation, the straight-line approximation 
method proposed in Section C of Chapter III actually produces a path as good or better in cost than the 
wavefront propagation path. Straight-line approximations of a path always go through the region root, which 
was on the original path. They also lie completely within an area of homogeneous cost, because homogeneous- 
behavior regions are star-shaped with respect to the region root (Corollary I-1.4). By the triangle inequality, 
their cost is always less than or equal to the original path. So since costs of straight-line approximations are 
lower bounds on costs of wavefront-generated paths, the previously stated upper bound on percent error 
remains a valid upper bound. Can this upper bound be improved? 

Although in the case of most start cells, substantial improvement over the cost of model-optimal paths 


generated by wavefront propagation will be achieved by this path reconstruction method, the upper bound on 
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error cannot be tightened in general, because there will be situations where the error in placement of a bound- 
ary would cause a start point to be placed in an incorrect region, (although without exceeding the upper bound). 
Anexample of such a case occurs in Frame 5 of Figure 16, at the point labeled X. The optimal path from point 
X should be a straight line to the goal. But since wavefront propagation caused error in the placement of the 
vertical boundary (it should have been a "shadow boundary," a ray from the upper left vertex of the high-cost 
area extending directly away from the goal point), X is to the right of the vertical boundary instead of to its 
left, so itis associated with the region whose root is the top-left edge of the high-cost area. Thus, a reconstructed 
path will go in a straight line to the top of the high-cost area, and then cut across its corner and go the the goal. 
This path has a cost error close to the original upper bound. 

Thus the upper bound on percent error of the cost of wavefront-propagation-generated model-optimal 
paths with respect to real-world optimal paths remains as stated for the point-to-point version of the algorithm, 
1.e., 7.6%, although E est error will be improved by appropriate reconstruction of paths from the optimal- 


path map. 


B. TIME COMPLEXITY OF WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

As stated in Chapter II, point-to-point wavefront propagation implemented using Dijkstra’s algorithm has 
worst-case time complexity O(m log m), where there are m cells in the input map. In Algorithms B-1 (Appen- 
dix B) and IH-1 (Chapter III), however, the algorithm is modelled on the wavefront analogy, and Dijkstra's 
algorithm is not followed exactly (because cells may remain on the wavefront for more than one iteration, and 
a search for the minimum-cost edge is not done for each wavefront). As explained in Chapter II, the time com- 
plexity of this version is O(c m), where c is the maximum cost of a cell in the input map, time is incremented 
by 1 unit each step, and it is assumed that there is some upper bound on the size of c. 

The mechanism for detecting boundaries is to check each cell on the wavefront against each of its eight 
neighbors. There are eight, or O(constant) checks for each of the m cells in the map. Each boundary check in 
the pure version consists of an O(constant) comparison of the first turn points on the backpaths of the two cells 


being checked. So boundary-checking takes O(n1) time. This is added to the time for the basic algorithm. so 
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the pure version of wavefront-propagation optimal-path-map generation has the same asymptotic worst-case 
time complexity as point-to-point wavefront propagation, or O(c m). 

In the diverging-path version of wavefront-propagation optimal-path-map generation, the boundary check 
consists of a companson of the distance between the parents of the parents of the two cells. Again it is an 
O(constant) operation to follow two back-pointers for each cell and compute a distance, so boundary-check- 
ing takes O(m) time, and the diverging-path version is also O(c m). 

The vertex-edge version of wavefront-propagation optimal-path-map generation uses the same path lists 
as the pure version, but considers only so-called distinguished cells on the lists. A check of the first two dis- 
tinguished cells in a path list by procedure check-equivalent-paths will give a conclusive answer about 
whether or not two paths are "similarly behaved". This check is an O(constant) process where the first element 
in each list is retrieved, and the two elements compared. So the vertex-edge version also has worst-case time 
complexity O(c m). 

As discussed in Chapter III, the vertex-edge version requires preprocessing of the terrain to fit groups of 
homogeneous-cost cells to polygons or line segments, and to find vertices and edges. The algorithm of Wade 
and Rowe [Ref. 44] which does this has two passes. The first pass processes each cell once, in total O(m) time. 
The second pass is recursive, and a worst-case time complexity is not given, but for a map with k edge cells, 
is approximately O(log k). Under the above assumptions, the number of edge cells is significantly less than 
the number of cells, so k«m. Therefore the terrain preprocessing is dominated by the wavefront propagation 


algorithm. 


C. SPACE COMPLEXITY OF WAVEFRONT-PROPAGATION OPM-GENERATION 
ALGORITHMS 

The space required for the point-to-point wavefront propagation algorithm is simply O(m), where the 
input map has m cells. Storage is usually implemented bya Vm by Vm array which holds cost information 
and a pointer to the parent of the cell on its backpath. During execution, another data structure will hold the 
coordinates of those cells currently on the wavefront. When the algorithm is expanded to deal with the two- 
dimensional, or optimal-path-map case, several new data structures must be added. First, for the pure and the 


vertex-edge versions, two fields must be added to the cell array to hold the coordinates of the cell's parent on 
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the optimal-path list (in general not the cell’s parent on the backpath). Secondly, new data structures must be 
added to hold the output. These data structures are the DCEL and the optimal-path tree. 

As explained in Chapter II, Section B, a doubly-connected edge list (DCEL) along with an optimal-path 
tree are well suited to representing the optimal-path map. The size of the optimal-path tree is proportional to 
the number of homogeneous-behavior regions in the optimal-path map, since there is one node per region. 
Since in the worst case there could be no more than one region per cell, the optimal-path tree will never re- 
quire more than O(m) storage. In fact as discussed above, the number of regions is assumed to be significant- 
ly larger than the number of cells, so the optimal-path tree will only require a small fraction of the total number 
of cells in the input map, and is more accurately a function of the number of terrain feature vertices and edges, 
or O(v +e). 

The DCEL represents the planar partition by listing characteristics of each line segment, or edge, in the 
partition. Since each se een of the wave front-propagation-OPM boundaries is designated as lying between 
two specified cells, there can never be more than O(m) boundary segments, and in fact, the one-dimensional 
nature of boundaries will tend to produce an DCEL of O(Vm) size. In terms of terrain-feature vertices and 
edges, it is Shown in Chapter V that any given vertex or edge has a constant number of region boundaries as- 
sociated with it, so the DCEL will have size of O(v + e). Note that the O(m) input map can be discarded after 
preprocessing, so the amount of storage needed at run-time will be O(v - e). | 

In practice, a great amount of storage can be saved in the way the planar partition is represented by the 
DCEL. As produced by the wave frout-propagation OPM-generation algorithm, boundaries are represented by 
lists of cell edges (perhaps implemented simply by listing coordinates in the same coordinate system as the 
cells, but incremented or decremented by .5). But in fact, boundaries in the grid-based domain typically con- 
tain long, near-linear sequences, so the number of edges in the DCEL can be reduced greatly by representing 


only endpoints of such sequences. Figure 16 shows about half of the boundaries to be linear. 


D. EMPIRICAL PERFORMANCE OF WAVEFRONT-PROPAGATION OPM 
IMPLEMENTATIONS 
The three versions of the OPM-gencration algorithm described in Section B of Chapter 111 were imple- 


mented in Common Lisp on a Synibolics 3620 Lisp Machine. Although no spectal effort was made to make 
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these implementations efficient, some idea of the relative performance of the four versions, and some rough 
idea of the performance of wavefront propagation in general, can be gained by observing actual run-times. 
Table 3 shows average elapsed times for two typical input maps, based on the Lisp function "get-universal- 


time". These real-time figures give some rough idea of the actual performance of these implementations. 
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TABLE 3 


WAVEFRONT-PROPAGATION OPM-GENERATION 


RELATIVE PERFORMANCE OF THREE VERSIONS 


l 
(average CPU Time) 
(average Real Time) 


2 
(average CPU Time) 
(average Real Time) 


NOTES: 


Yersion Version 
449,759 cycles 793,094 cycles 
493 sec 843 sec 


1,558,722 cycles 916,535 cycles 


1,714 sec 


973 sec 


Vertex-Edge 


2,292,827 cycles 


2,440 sec 


2,013,910 cycles 
2113 sec 


(1) Average CPU Time is elapsed time as per machine-dependent LISP function "get-internal-run-time" 


averaged over eight runs. 


(2) Average Real Time is elapsed time as per LISP function "get-universal-time" averaged over eight runs. 


(3) Versions were implemented in Common-Lisp on a SymbolicsTM 3640 operating under Genera 4,1TM, 


(4) Map 1 was 199 by 150 cells (1.e., 29850), with one obstacle and one high-cost feature, 12 vertices and 


12 edges, with 465 cells, or 1.5%, of infinite cost (obstacle cells) and 741 cells, or 2.5%, of cost two. 
(5) Map 2 was 199 by 150 cells (1.e., 29850), with three obstacles, 15 vertices and 15 edges, with 619 cells, 


or 2.196, of infinite cost. 
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V. CHARACTERIZATION OF REGION BOUNDARIES 


In this chapter, we formulate the geometrical groundwork necessary for an OPM construction algorithm 
which relies on spatial reasoning to eliminate much of the inaccuracy inherent in the wavefront propagation 
OPM construction algorithm. The algorithm applies to maps consisting of the five types of terrain defined in 
Chapter I, Section E, obstacles, roads, rivers, homogeneous-cost areas (HCA), and homogeneous-cost back- 
ground. The approach we use is to determine the analytic characteristics of boundaries between regions of 
similarly-beliaved optimal paths as functions of terrain feature characteristics. Jt tums out that all boundaries 
associated with the first three of the above terrain feature types (roads, rivers, and obstacles) are segments of 
conic sections. Boundaries associated with HCA’s are more mathematically complex, and in many cases do 
not appear to have closed-form expressions. In addition to the algebraic form of these boundaries, we develop 
the theory which describes the circumstances in which each type of boundary occurs. The algorithms described 
in Chapter VI will rely on the results developed in this chapter for the basic steps involving construction of 
each boundary. 

First, primitive terrain features, that is single polygonal obstacles and homogeneous-cost areas, and single 
river and road line segments, are studied and the boundaries they generate are characterized. Then a unifying 
theory is introduced which underlies all types of boundaries as they occur in terrain as defined herein. Develop- 
ment of algorithms for constructing OPM’s for each of the primitive terrain features and for combined terrain 
is deferred until Chapter VI. Appendix C contains additional examples of optimal-path maps for each of the 


primitive terrain features presented. 


A. REGION BOUNDARIES ASSOCIATED WITH PRIMITIVE TERRAIN FEATURES 

Table 4 summarizes the types of homogeneous-behavior-region boundaries associated with each type of 
primitive terrain feature. Each type of terrain feature is listed in the left column. The second, third, fourth, and 
fifth columns contain the names of the boundary types associated with that terrain feature which are linear, 
parabolic, hyperbolic. and non-conic respectively. Since there are four cases of homogeneous-cost area (HCA) 
depending on whether the goal is inside or outside the HCA and on whether the HCA cost is higher or lower 


than the surrounding terrain, each of which has distinctively different boundaries, these four cases are listed 
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Obstacle 


River Segment 


Road Segment 


High-Cost 
Exterior-Goal 
HCA 


High-Cost 
Interior-Goal 
HCA 


Low-Cost 
Exterior-Goal 
HCA 


Low-Cost 
Intenor-Goal 
HCA 


Multiple- 
Connected 
River Segments 


TABLE 4 
SUMMARY OF HOMOGENEOUS-BEHAVIOR-REGION 
BOUNDARIES BY TERRAIN TYPE 


FORM OF BOUNDARY 

LINEAR PARABOLIC HYPERBOLIC NON-CONIC 
Shadow(c/c) Opposite-edge(c/c) 
Obstacle-edge 
Shadow(c/c) River-opposite-edge(c/c) 
River-edge River-crossing(c/c) 
Road-edge Near-side-road- Road-end/goal(c/c) 
Rd-end/road- travelling/goal(p/c) 

tvlg(c/p) Far-side-road- 
Rd-tvlg/road- travelling/goal(p/c) 

crossing(p/c) 
Shadow(c/c) 
HCA-edge Opp-edge-0-thru- Visible-edge(d/d) 
Hidden-edge/ interior(c/c) Visible-hidden- 
merging-path(p/p) Opp-edge-1-thru- edge(d/p) 
Hidden-edge/ interior(c/d) Comer- 

diverging-paux(p/p) Opp-edge-2-thru cutting(c/d) 
Shadow(c/c) interior(d/d) 
HCA-edge Hidden-edge/goal(p/c) ^ Exterior-opposite- Comer-cutting 
Shadow Visible-edge/goal(p/c) edge(c/c) (c/d) 
Hidden-edge(p/p) Visible-edge(d/d) 
Interior-opposite-edge(p/p) 
HCA-edge Edge-following/goal(p/c) Vertex/goal(c/c) Edge-xing/(d/c) 
Vertex/edge-following(c/p) Opposite-edge(d/d) 
Vertex-edge-crossing(c/d) Visible-edge(d/d) 
HCA-edge 
Vertex/edge-crossing(c/d) 
Shadow(c/c) River-opposite-edge(c/c) 
River-edge River-crossing( c/c) 


Near-side-river-crossing(c/c) 


de 


separately. Also listed with each boundary name is a coded description of what type of cost functions are as- 
sociated with the homogeneous-behavior regions on either side of the boundary. The code "c" means the cost 
function of a region ts conical, "p" means it is planar, and "d" means it is a "distorted cone". Terrain-feature 
edges always form boundaries, which of course are linear since terrain-feature edges are linear, but are not as- 
sociated with a particular cost function, so no code is shown. (See Section C for a discussion of cost functions.) 
1. Obstacles 

We begin by characterizing boundaries associated with a single obstacle in homogeneous-cost back- 
ground terrain (see Theorem V-1, Appendix A). (The types of boundaries associated with obstacles have pre- 
viously been determined by Mitchell [Ref. 4] using different terminology.) With respect to obstacles, define 
a visible edge to be an edge for which no point on the edge has an optimal-path list whose first element lies 
on the obstacle perimeter. Define a hidden edge as a non-visible edge, 1.e., an edge for which some point on 
the edge has an optimal-path list whose first element lies on the obstacle perimeter. In the case of terrain con- 
taining only a single obstacle, this means that both visible-edge vertices are visible to the goal point. In Figure 
17, edges AB and BC are visible edges. Edges CD, DE, and EA are hidden edges. (Many of the following 
figures are similar in format. Terrain features are shown as polygons or line segments. Homogeneous-behavior- 
region boundaries are shownas solid curves. Occasionally continuations of the boundaries are shown as dashed 
lines to clarify the form of a boundary. In many of the figures a field of small vectors represents the initial 
direction of the optimal paths from a sampling of start points. These fields are not part of the optimal-path 
map. but serve to illustrate the directions paths take and to corroborate the correctness of plotted boundaries.) 
Define an opposite edge to be the obstacle hidden edge for which the optimal path lists of neither vertex in- 
cludes the other. An isolated obstacle has exactly one opposite edge (Lemma V-1.3, Appendix A). Edge DE 
is the opposite edge in Figure 17. A special case is that in which the role of the opposite edge is assumed by 
an obstacle vertex: this 1s ruled out by the general position assumption discussed in Chapter 1, although the 
analysis for including such a case is a simple extension of the below. Define an opposite point as the point on 
the opposite edge with two distinct optimal paths, one through each vertex of the opposite edge. 

There are three types of boundaries associated with obstacles. Obstacle edges are trivial boundaries, 
since they separate regions whose optimal-path lists are [[]. goal-point] from regions with non-degenerate op- 


timal-path lists (see Lemma V-1.1). Obstacle shadows emanate from vertices of hidden edges in a straight 
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Obstacle 


fin 


line, as if the goal were a point light source; each vertex of a hidden edge generates a shadow boundary. For 
those vertices which join a hidden edge and a visible edge, the line segment lies on the line defined by the ver- 
tex and the goal; for those vertices which join two hidden edges, the line segment lies on the line defined by 
that vertex and the vertex of the hidden edge which is included in the first vertex's optimal path. (See Figure 
17 aud Lemma V-1.2, Appendix A). 

Each obstacle also has exactly one opposite-edge boundary which emanates from the opposite edge 
of an obstacle, and consists of segments of hyperbolas. This follows directly from the definition of a bound- 
ary by the application of basic analytical geometry (see Lemma V-1.4, Appendix A). The hyperbola is defined 
by considering the vertices V1 and V2 of the opposite edge as foci. Choosing a coordinate system such that 
the x-axis intersects both foci and the origin is mid-way between them, Equation | describes the opposite-edge 
boundary. Forcing constant a to be positive restricts Equation 1 to the one branch of the hyperbola which is 
closer to the higlier-cost focus. The segment of this branch which is active as a boundary begins at the point 


on the opposite edge intersected by the branch and continues away from the obstacle. (See Figure 17). 


J 
tion 1 i 
(Equation 1) 3 = Pe where a= (IGV2l - IGV11)/2, IGVal >IGVIl, 
a 


c=1V1Val/2, and b? E c^ - ac 


If at any point the opposite-edge boundary intersects a shadow boundary, it will become defined by 
another hyperbola from that point on. This second hyperbola is defined by considering as foci (1) the vertex 
of the edge associated with the shadow boundary and which is the closer to the goal of the two vertices of that 
edge, and (2) the focus of the previous hyperbola which is not also a vertex of the edge associated with the 
shadow. The hyperbolic constant is computed as before, using the costs from the foci to the goal. The segment 
begins at the point where the second liyperbola intersects the first hyperbola, and continues away from the 
obstacle. The direction of curvature of the second hyperbola may be the same or opposite that of the first. (See 
Figure 17). 

2. River Segments 
Single isolated river segments generate four types of boundaries (see Figure 18 and Theorem V-2, 


Appendix A). Rrver-edges are trivial boundaries (Lenima V-2.1). Shadow boundaries are associated with each 
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river vertex, and are half-lines starting at a river vertex and lying directly away from the goal (Lemma V-2.2). 
River-crossing boundaries differentiate between paths that cross a river and ones that go around its end. A 
river-crossing boundary is a segment of a hyperbola defined by considering the river vertex V and the goal G 
as foci, with the constant in Equation 1 being a 2 IVGI/2. The segment begins at the point at which the hyper- 
bola intersects the river and ends at the point at which it intersects the river-obstacle boundary (below). This 
type of boundary may not appear if the river-crossing cost is too high or if the angle between the river and the 
goal-to-river-end line approaches or exceeds 90". (Lemma V-2.3). A river segment will act like an obstacle 
when the distance of the start point to the river plus the river-crossing cost is large compared with the distance 
from the river to the goal. If this occurs, a boundary will start at the intersection of the two river-crossing boun- 
daries, if they exist, or if not at the nver edge. This opposite-edge boundary will be a hyperbola defined by the 
two river-end vertices V; and V2 as in the obstacle opposite-edge case above. (Lemma V-2.4). The river shadow 
boundaries will never intersect the opposite-edge boundary, so it will consist of only one hyperbola segment. 
3. Road Segments 

Single isolated road segments are associated with various types of boundaries, depending on their 
onentation with respect to the goal (Theorem V-3, Appendix A). Consider a wedge with the goal G as the ver- 
tex, formed by extending two rays from G through the line of the road intersecting the line at two points A and 
B, so that the interior angles GAB and GBA are the angle Yc = 1/2—O¢, 0. the critical angle such that O = 
sin” (R/S), for R the road cost, and S the cross-country cost, where R is greater than S. Call this the charac- 
teristic wedge of the road segment. (See Figure 19.) We adopt the convention for the following discussion that 
the wedge intersection points A and B are labelled such that their relative positions on the road line are the 
same as the relative positions of the two road vertices V; and V2 (e.g., if Vj is to the right of V2 on a certain 
map, then A is to the right of B). When A and B and V; are arrayed along the road line in the order B,A,V 1, 
(irrespective of V2's position), say that the characteristic wedge is inside Vi. When they are arrayed in the 
order B, V1,À or when A and V; are the same point, say that the wedge straddles V1. When they are arrayed 
in the order V1,B,A, say that the wedge is outside V1. There are seven types of boundaries induced by road 
segments, as listed below. When the characteristic wedge is inside Vi, types a,b,c, and d exist on the Vj end 
of the road segment. When the characteristic wedge straddles Vi, types a and g exist on the V; end. When the 


characteristic wedge is outside V 1, types a.d, and f exist on the V^ end, and vice versa. When the characteris- 
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Cliamacternstic Wedges 


2 


tic wedge is inside both V and V2, type e also exists on each end. When the characteristic wedge is inside Vj 
and straddles V2, type e exists on tlie V; end only. Figure 20 and Figure 21 show two example road seginents 
with their Td boundaries (labeled a). 

Type a: Road-edge boundaries separate paths which start on one side of a road from those which start 
on the other side. All road segments will constitute road-edge boundaries (Lemma V-3.1). For example, the 
road segment V1 V2 in Figure 20 is a road-edge boundary. 

Type b: Road-end/road-travelling boundaries separate paths which go to a road end and begin using 
the road fron! those which go to a road interior point and begin using the road. They are linear, and form a fan- 
shaped region at the road end. When the characteristic wedge is inside a road-end vertex V, there will be two 
road-end/road-travelling boundaries beginning at V and forming angles of 1/2—0.; and 0.—7/2with the 
road. (Lemnia V-3.2). Figure 20 shows four sucli boundaries (labeled b), two each emanating froni road ver- 
tices V j and V2, because the characteristic wedge is inside both V and V2. Figure 21 shows two road-end/road- 
travelling boundaries emanating from vertex V2, because the wedge is inside V2, but none from V1 because 
the wedge is outside Vj. 

Type c: Road-erd/goal boundaries separate paths which travel directly to the goal from paths that 
travel to a road end and then along the road. These boundaries are segments of hyperbolas where road-end V 
and goal G are the foci, and the hyperbola is described by Equation 1, where Vi=G and V2=V. The boundary 
begins at the point where the hyperbola intersects tlie road-end/road-travelling boundary. A road-end/goal 
boundary exists on the goal side of the road segment for vertex V1 if and only if a pair of road-end/road-travell- 
ing boundaries exist: if the characteristic wedge is outside V2, a road-end/goal boundary will also exist on the 
far side of the road segment for vertex V1. (Lemma V-3.3). In Figure 20, two such boundaries exist (labeled 
C), one associated with each vertex of the road segment, and both on the goal side of the road, although tlie 
boundary on the V2 end is not shown being off the page to the bottom. In Figure 21, two such boundaries exist 
associated with V2, although both are off the page. 

Type d: Near-side road-travelling/goal boundaries lie on the near side of the road (i.e., on the goal 
side) and separate paths which enter a road interior, travel along it, and then exit the road to cut over to the 
goal from those which go directly to the goal. These boundanes are descnbed by segments of parabolas defined 


for road-end vertex V1 as follows: the focus of the parabola ts the goal, G, and the directrix is the line perpen- 
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Road Segment Example 2 


dicular to the characteristic wedge ray GB and which intersects the ray GB, and is a distance IGAI from A if 
the characteristic wedge is inside V; and not outside V2, and a distance IGV?l from V2 if the wedge is inside 
V1 and outside V2. This parabola is described by Equation 2, where the y-axis is the directrix and the x-axis is 


the axis of the parabola. 


(Equation 2) y? =4px where p=d cos^(0.)/4 


for d 2 IGAl if wedge not outside V2, 
and d = IGV il if wedge is outside V2. 


The segment of the parabola which is a boundary begins at point A if the characteristic wedge is in- 
side V; and not outside V2, and begins at point V1 1f the characteristic wedge is inside V1 and outside V2. It 
ends at the point where the parabola intersects the near-side road-end/road-travelling boundary and the road- 
end/goal boundary if there is a road-end vertex, and continues indefinitely if there is not. It exists under the 
same conditions as these two exist. (Lemma V-3.4). Figure 20 shows two near-side/road-travelling boundaries 
(labeled d), because the wedge is inside both V; and V». The directrices Dj and Do are distances IGAI from A 
and IGBI from B respectively, because the wedge is inside both V) and V2. If the wedge had straddled either 
vertex, the same distances would continue to apply. Figure 21 shows one near-side/road-travelling boundary, 
but this one has a directrix (not shown) with a distance IGV il from V because the wedge is outside Vj. ' 

Type e: Road-travelling/road-crossing boundaries separate paths which begin on the far side of the 
road from the goal and travel along the road from those which also begin on the far side but cross the road and 
go directly to the goal. This type of boundary will exist for road-end V, when the characteristic wedge is in- 
side V | and not outside V2. It is linear (a ray), and is the portion of the characteristic wedge ray beginning at 
A and lying on the far side of the road. (Lemma V-3.5). Figure 20 shows examples of two road-travelling/road- 
crossing boundaries which occur because the characteristic wedge is inside both vertices. Figure 21 has no such 
boundaries, because the wedge is outside V2. 

Type f: A far-side road-travelling/goal boundary occurs on the V¡ end when the characteristic wedge 
is outside Vj. It is a segment of a parabola with focus G and directrix D such that D is perpendicular to the ray 
GA, but does not intersect it (i.e., D les on the other side of G from A), and D2 is distance IV GI from V1. This 


parabola is defined similarly to the one in Equation 2, except that dzlV 1Gl. One far-side road-travelling/goal 


boundary occurs in Figure 21 on the V2 end of road segment because the characteristic wedge is outside V2. 
Non occurs in Figure 20, because the wedge is outside neither vertex. 

Type g: A road-shadow boundary occurs when the characteristic edge straddles a vertex V. It separates 
points whose paths cross the road en route to the goal from those which go directly to the goal. The shadow 
boundary is a ray starting at V and lying directly away from G. (Lemma V-3.7). Note that since paths which 
cross roads pay no additional cost, this type of boundary occurs only by convention. We want path descriptions 
to reflect each terrain-feature-edge crossing, even though no change in direction or cost rate occurs for this 
case. This type is not illustrated in the accompanying figures. 

4. Homogeneous-Cost Areas (HCA) 

Homogeneous-cost areas (HCA) generate boundaries both inside and outside the HCA. The outside 
boundaries are similar, although not identical, to those associated with obstacles, rivers, and roads. This is not 
surprising, since the HCA is a generalization of each of these types of terrain. There are four cases, based on 
the relative costs of the HCA interior and exterior and the location of the goal inside or outside the HCA. We 
first consider the case where the cost of the interior of the HCA is greater than the cost of the exterior and the 
goal point lies outside the HCA, then the high-cost, interior-goal case, the low-cost exterior-goal case, and the 
low-cost interior-goal case. 

a. High-Cost HCA With An Exterior Goal 

When the goal is exterior to the homogeneous-cost area, and the cost of the HCA is greater than 
the surrounding terrain, boundaries occur according to Theorem V-4, Appendix A. Define a visible edge of an 
HCA to be an HCA edge for which no point on the edge has an optimal-path list whose first element lies on 
the HCA perimeter. Define a hidden edge as a non-visible edge, i.e., an edge for which some point on the edge 
has an optimal-path list whose first element lies on the HCA perimeter. Thus a hidden edge may have points 
whose optimal paths travel through the HCA, which would mean that their opumal paths would have as their 
first element the visible edge across which they pass. Define opposite-edge sequence as the smallest connected 
sequence of hidden edges for which the first and last endpoints of the edge sequence have optimal paths whose 
initial directions follow the HCA edges in opposite (i.e., clockwise versus counterclockwise) directions. If no 
such endpoint can be found at one end or the other of the sequence of hidden edges, let the endpoint at that end 


be the "outer" vertex of the last hidden edge. i.e.. the vertex which joins the last hidden edge in the clockwise 
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(or counterclockwise) direction with the first visible edge in the clockwise (or counterclockwise) direction. In 
Figure 22, the initial direction of optimal paths for each edge endpoint is shown as a vector. HCA I has op- 
posite-edge sequence ED, HCA 2 has opposite-edge sequence EDCB, HCA 3 has opposite-edge sequence 
FED, and HCA 4 has opposite-edge sequence JIHFE. Essentially, this definition specifies the range over which 
a search must be conducted for an opposite point, if one exists, and defines the HCA vertices which may 
generate opposite-edge boundaries (see below). Define the opposite point of an HCA as a point with two op- 
timal paths lying in opposite directions (i.e., clockwise and counterclockwise) along HCA edges. If "shortcut- 
ting" occurs through the center of HCA, the opposite point might not exist, as in HCA 2 and HCA 3 of Figure 
p». 

Define the critical angle Q< of an HCA as sin” (c1/c2) where the cj are the unit costs inside and 
outside the HCA, and cj > C2. An optimal path crossing an HCA edge will obey an analogue of Snell’s Law 
in optics [Ref. 20] (see Chapter II, Section E) so that for angle of incidence 8; and angle of refraction Q2, 
and cost rates c1 and c2 on either side of the edge, c1 sin(01) - c2sin(02). (See also Chapter II, Section 
E2b(3) and Figure II-8). 

Inside a high-cost HCA with extemal goal, there are four types of boundaries (See Figures 23, 
24, and 25). Each pair of HCA edges is potentially associated with an interior boundary. The boundary type 
depends on whether the edges are visible or hidden, and are on the same or opposite sides of the — ge 
boundary. A visible-edge boundary distinguishes optimal paths which go through two different visible edges: 
the optimal paths cross their respective edges according to Snell's Law. Lemma V-4.1 (Appendix A) states 
the analytic form of such a boundary. Although not expressible in closed form, the boundary has much the 
same shape as a hyperbola segment which forms an obstacle opposite-edge boundary, i.e, it has positive but 
decreasing curvature from its point of incidence upon an HCA vertex inward into the HCA, and this curva- 
ture is typically small so that the curve is almost lincar. An example of a visible-edge boundary is found in 
Figure 23, labeled a. 

A visible-hidden-edge boundary distinguishes optimal paths going through a visible edge from 
those going through a hidden edge; the latter paths traverse the HCA edge at exactly the critical angle and the 
follow the edge. Lemma V-4.2 states the analytic form of this type of boundary, which again is similar to a 


hyperbola. Examples of this type of boundarv occur in Figures 23, 24, and 25 and are labeled b. 
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Figure 24 
High-Cost, Exterio1-Goal HCA Example 2 
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Figure 25 
High-Cost, Exterior-Goal HCAÀ Example 3 
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A hidden-edge merging-path boundary distinguishes optimal paths leaving the HCA at two dif- 
ferent hidden edges at exactly the critical angle, and for which all paths merge before the goal. A way to check 
for this behavior is to see if an optimal path from a vertex of one of the edges includes a vertex of the other 
edge. Lemma V-4.3 states the analytic form of this type of boundary, which is a line segment. The boundaries 
labeled c in Figures 23, 24, and 25 are hidden-edge merging-path boundaries. A htidden-edge diverging-path 
boundary is like the preceding except the two classes of paths merge only at the goal. This type of boundary 
is also a line segment, as stated in Lemnia V-4.4. Examples of this type of boundary occur in Figures 24 and 
25 and are labeled d. 

Each pair of adjacent edges is always associated with one of the above interior boundaries, while 
non-adjacent edges may or may not be. If shortcutting does not occur across an HCÀ corner, a boundary will 
start at the vertex at that corner. If shortcutting does occur, the boundary associated with that vertex will in- 
tersect the HCA edge at the point where shortcutting starts (see Figure 23 where two of the boundaries labeled 
b intersect the opposite edge, Figure 24 where one of the boundaries labeled b intersects the lower right edge 
of the HCA, and Lemma V-4.5). From the vertex or shortcutting point at which such a boundary begins, it will 
continue into the HCA interior until it intersects another boundary or HCA edge. At the point at which two 
such boundaries first intersect they will terminate, and a third boundary will begin which represents the division 
between the two regions which the first two boundaries did not have in common. For example, in Figure 23 
the boundary associated with vertex V ; distinguishes paths which cross edge V1V2 from tliose which travel 
along edge Vi V5, while the boundary associated with vertex V5 distinguishes those which travel along edge 
V¡Vs from those which travel along edge V4V5 passing through vertex V5. These two boundaries begin at 
their respective vertices and intersect in the HCA interior, and from that point a third boundary begins which 
distinguishes paths which cross edge V; V2 from those which travel along edge V4V 5 passing through vertex 
Vs. These two descriptions ("crossing V¡V2" and "travelling along V4V5 through V5") represent the two 
regions which the initial boundaries did not liave in common, so they characterize the third boundary. Boun- 
dares will continue to intersect and new ones begin in the HCA interior until the boundary associated with 
each visible vertex 1s joined with one or more hidden vertices or HCA edges (Lemmas V-4.10 and V-4.11). 

These networks of boundaries can be represented as trees, wliere each boundary is considered a node. and 


edges connect nodes whose boundaries intersect (see Lemma V-4.10). Such a tree, called an interior-bound- 
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ary tree, has interior nodes with exactly two children, while the root of such a tree can have zero, two, or four 
children. A tree whose root and sole node has zero children represents a boundary which goes from one edge 
of the HCA to another without intersecting any other boundaries, such as the boundary emanating from ver- 
tex V2 in Figure 23. A boundary separates two regions, and any time two boundaries intersect it must be, as 
explained above, that they have one of the two regions in common. Beyond the point of intersection, the two 
regions they did not have in common must be separated by a boundary. Thus each time two boundaries inter- 
sect, a third must begin. We choose as leaf nodes those boundaries associated with HCA vertices, because one 
of these boundaries is guaranteed to exist for each vertex, and no other interior boundaries intersect it at the 
vertex or edge, so we can be sure that they will have no children. At the other end of such a boundary it either 
intersects an HCA edge, meaning its node is a root without children as described above, or it intersects two 
other boundaries, one of which will also be associated with an HCA vertex and so be another leaf node. If the 
latter is true, the boundary beginnning at the intersection point of the two leaf- node boundaries will serve as 
the parent node of the two boundaries. This merging of boundaries will continue until the parent node’s bound- 
ary intersects an HCA edge, in which case the node is the tree's root, or until roots of two boundary trees are 
found to represent the same boundary, in which case the two trees can be merged into one. This is the case 
where a root will have four children, representing the two boundaries which intersect each end of the root's 
boundary. Several examples and illustrauons of the construction of such interior-boundary trees are bm in 
Chapter VI. 

Outside the HCA, there are four types of boundanes Again, HCA edges are trivial boundaries 
(Lemma V-4.5). HCA shadow's are defined exactly as for obstacles (Lemma V-4.6). Examples of HCA shadow 
boundaries are labeled e in Figures 23, 24, and 25. The other two types are HCA opposite-edge boundaries 
and HCA corner-cutting boundaries. HCA opposite-edge boundaries are the generalization of obstacle op- 
posite-edge boundaries, and differentiate between paths which start outside the HCA and go through or around 
the HCA in different directions. There are three types of opposite-edge boundaries, depending on whether 
neither, one, or both optimal paths go through an HCA edge. A path which does not go through the HCA goes 
around ìt initially via one ofits vertices. The case where neither path goes through the HCA is the same as the 
obstacle opposite-edge boundary case. and is described by connected hyperbola segments. The first and second 


cases have more complicated analytic forms. although the shape of the boundaries ts very similar to hyper- 
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bolas. (Lemma V-4.7). In Figures 23, 24, and 25, opposite-edge boundaries are labeled f. In Figures 23 and 
24 all three cases occur, while in Figure 25 the HCA is a virtual obstacle, that 1s, it appears to points outside 
it that it is an obstacle, so the only opposite-edge boundary it has is the third, or hyperbolic case. 

HCA Comer-cutting boundaries occur when optimal paths cut into the HCA along an edge which 
is not part of the opposite-edge sequence. In fact, the analytic form of this boundary is just a variation of the 
second of the three types of opposite-edge boundaries discussed in the previous paragraph. Corner-cutting 
boundaries emanate from a vertex connecting a hidden and a visible edge when shortcutting occurs across 
those edges (for example, in Figure 24, labeled g). In the generalization of this case where the edges across 
which shortcutting occurs are separated by one or more edges, the comer-cutting boundary begins at the point 
at which the set of interior boundaries intersects the hidden edge (Lemma V-4.8). 

The construction of interior-boundary trees is useful in finding exterior boundaries. There is ex- 
actly one opposite-edge or corner-cutting boundary associated with each interior tree of boundaries, and each 
visible HCA vertex is connected, either directly or via its interior boundary tree, to an opposite-edge or comer- 
cutting boundary. (Lemma V-4.11). When an interior boundary tree includes as a leaf node an interior hidden- 
edge-diverging-path boundary, the point at which the boundary intersects the HCA edge is connected with an 
exterior opposite-edge boundary. When an interior-boundary tree includes as a leaf node a point of intersec- 
tion of an interior boundary and an HCA edge, but does not include an opposite point, for example, as hap- 
pens three times along the hidden edge of the HCA in Figure 22, this point of intersection is connected with 
an exterior opposite-edge or cormmer-cutting boundary. When as happens to the rightmost vertex in Figure 24, 
a vertex is not connected with any interior boundary tree, corner shortcutting occurs and a corner-cutting bound- 
ary is connected with the corner vertex. Two HCA opposite-edge boundaries or comer-cutting boundaries may 
intersect each other or a shadow boundary, and if they do a third boundary begins at the point of intersection 
and lies away from the goal, as in the case of obstacle opposite-edges. 

An optimal path will travel into a high-cost HCA from outside it only across an edge which forms 
an angle greater than sin’ '(20c) with another connected HCA edge [Ref. 20]. If none of the hidden edges are 
associated with included angles of less than 20. with connected visible edges and the cost ratio and dimen- 
sions of the HCA allow, it acts exactly as an obstacle with respect to all start-points outside the HCA. Such an 


HCA is called a virtual obstacle. The HCA shown in Figure 25 is a virtual obstacle. If all the opposite-edge 


and comer-cutting boundaries converge and become a single opposite-edge boundary away from the goal, the 
HCA becomes, for all points beyond the point of convergence, a virtual obstacle. 
b. High-Cost HCA With An Interior Goal 

An HCA containing the goal point and with higher cost than the surrounding terrain generates a 
set ofexterior boundaries similar to the high-cost exterior-goal case, while the interior boundaries are reminis- 
cent of road boundaries. The similarity to road boundaries arises because for start-points inside the HCA, it 
may be profitable to move away from the goal point initially in order to travel along an HCA edge in the ex- 
terior, lower-cost region, just as if there were a road segment along the HCA edge. Figure 26 illustrates the 
high-cost interior-goal case (see Theorein V-5). 

We will define edges for this case with respect to each of its vertices, so that an edge may be 
defined differently for each of its endpoints. Define a visible edge with respect to one of its vertices V as an 
edge for which the optimal path from V cuts into the HCA interior at some point along the edge (either im- 
mediately from V or along the edge interior). Define a hidden edge with respect to V as an edge for which the 
optimal path from V starts along the other edge incident to V, or for which no optimal path from any point on 
the edge cuts directly into the HCA intenor. Define an opposite edge as an edge which is a hidden edge with 
respect to both its vertices. There are four types of interior boundaries, which are line segments and parabola 
segments. Each HCA vertex can generate a set of boundaries. For each vertex V, if the optimal-path iar that 
vertex consists only of the goal point, i.e, if the optimal path from the vertex goes directly to the goal, then 
there are no interior boundaries associated with that vertex. 

If on the other hand tbe optimal path from HCA vertex V travels initially along an HCA edge, 
cali the edge along which the path travels initially E2, and call the other HCA edge incident upon V (along 
which the path does not travel) Ej. In this case there will be a boundary associated with vertex V which is a 
line segment. This boundary starts at V and separates paths which cut over to edge E; and go through V from 
those which cut over to edge E2, bypassing V. This is a /iidden-edge boundary as defined for the exterior-goal 
case above. (In Figure 26, boundaries labelled a are hidden-edge boundaries. Also see Lemma V-5.1 in Ap- 
pendix A). In this case there will also be a parabolic boundary called a /iidden-edge/goal boundary. which 
separates optimal paths which go directly to the goal from those which go initially away from the goal to edge 


Ey and from there through V and on around the HCA, cutting back tn to the goal at another point on the HCA 
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High-Cost, Interior-Goal HCA 
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perimeter. This parabola is formed by considering the goal point as the focus, and constructing the directrix 
sucli that it is perpendicular to a line front V into the HCA exterior which forms an angle of 7/2 + Q. with 
edge E1 , and such that it 1s a distance d from V where d = cost(optimal path from V)/ci, where c; = exterior 
cost. (See the boundaries in Figure 26 labeled b, and Lemma V-5.2, Appendix A.) 

If iun addition, the first tum point P on the optimal path from V is an interior point of edge Ez, 
i.e., if the second leg of the optimal patlı from V cuts into the HCA to the goal, there will be a boundary called 
a visible-edge/ goal boundary associated with V and edge E2 which separates paths that go directly to the goal 
from those which go initially back to E? then travel along E? to P, and then cut into the HCA at P to the goal. 
The visible-edge/goal boundary intersects the HCA edge at P. Again, the focus 1s the goal point, and in this 
case the directrix is perpendicular to a line from P into the HCA extenor which forms an angle with line seg- 
ment PV of 7/2 + O<, and which is distance d from P such that d = cost(OPL(P))/c i. (See Figure 26, the boun- 
daries labeled c, and Lemma V-5.3.) 

The other type of interior boundary occurs when two adjacent vertices on a hidden edge have 
optimal paths which both lie initially on an HCA edge, but which go in opposite directions around the HCA 
(i.e., for which neither optimal path includes the other vertex). This is the saine situation that occurs in the 
definition of an obstacle opposite-edge, and so such an edge is called an /7CA opposite edge. However, there 
may be zero, one, or more opposite edges in this case. Each HCA opposite edge V1V2 generates an interior 
opposite-edge boundary, which separates paths which exit the HCA and go through vertex V1 from those 
which exit and go through vertex V2. (See Figure 26, the boundary labeled c, and Lemma V-5.4.) 

The exterior boundaries in thus case are quite similar to the high-cost exterior-goal HCA case. 
There are five types of exterior boundaries. /JCA edges are trivial boundaries (Lenitma V-5.5). Shadow boun- 
daries are associated with each vertex V whose optimal path OPL(V) includes as its first path-vertex a point 
P on the HCÀ perimeter. The shadow boundary is constructed by extending a ray from V along line VP away 
from P. (See Figure 26, boundaries labeled e. aud Lenima V-5.6.) 

Opposite-edge boundaries enanate from each HCA opposite edge. An opposite-edge boundary 
begins at an opposite point with a hyperbola segment and extends outward from the HCA, being formed ex- 
actly as in the extertor-goal case. Since there may be more than one opposite edge, there may also be morc 


than one opposite-edge boundary. (See Figure 26. boundaries labeled fand Lemma V-5.7.) Vistble-edge boun- 


J 


daries separate paths which cross two edges en route to the goal. This type of boundary exists whenever an 
optimal path from an HCA vertex goes directly to the goal. The boundary starts at the vertex and lies outward, 
possibly terminating when it intersects the next kind of boundary. (See boundary labeled g in Figure 26, and 
Lemma V-5.8.) Corner-cutting boundaries emanate from points at which hidden-edge/goal boundaries from 
the interior intersect the HCA edge. They separate points whose optimal paths cross the edge from those which 
go around the edge vertex. These boundaries begin at the HCA edge and are concatenated with new curve seg- 
ments at each point at which the earlier curve intersects a shadow boundary, as in the corner-cutting case above. 
(See boundaries labeled li ini Figure 26, and Lemma V-5.9.) 
c. Low-Cost HCA With An Interior Goal 

Analysis of an HCA with lower cost than the surrounding terrain, where the goal is in the HCA 
interior, shows a much simpler set of boundaries (Theorem V-6). There will never be any boundaries inside 
the HCA in this case, because there 1s no incentive for an optimal path to move away from the goal to the high- 
cost, external terrain, and there are no terrain-feature edges or vertices between any point in the HCA and the 
goal, since our HCA’s are assumed convex. (See Lemma V-6.1, Appendix A.) External boundanes will occur 
in pairs, forming a wedge emanating from each vertex of the HCA, much as in the case of road-end/road travell- 
ing boundaries for a road segment. The external boundaries are all rays which begin at an HCA vertex and lie 
away from the goal, and can be constructed by tracing a path from the goal to the vertex, and then employing 
Snell’s Law for the path with respect to each of the edges incident to the vertex to determine the orientation 
of the two boundaries. Call this type of boundary a vertex/edge-crossing boundary (see Lemma V-6.2). Figure 
27 shows a low-cost HCA with interior goal, and the boundaries it induces on the plane. 

d. Low-Cost HCA With An Exterior Goal 

The final case, where the cost inside the HCA is lower than the surrounding terrain and the goal 
is outside the HCA, bears some similarities to the low-cost, interior-goal case and some to the high-cost, inte- 
rior-goal case. In this case, parabolic and similar boundaries occur outside the HCA, treating HCA edges as 
if they were roads. and the wedges which occur in the low-cost, interior-goal case are present in this case as 
well. Only one type of boundary occurs in the HCA interior, and seven types occur in the HCA exterior 


(Theorem V-7). Figure 28 illustrates a typical low-cost, extenor-goal HCA. 
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In the exterior, in addition to the trivial edge- boundaries (Lemma V-7.1), boundaries can be con- 
structed by considering the behavior of the optimal path froin each of the HCA vertices. For each vertex V of 
the HCA, let E; and E2 be the edges incident upon Y, while V; and V2 are the vertices such that VV; - Ej 
and VV2 = E2. Additionally, let vertex V1 be closer to the goal than vertex V2, 1.e., the cost of the optimal 
path from V; be less than the cost of the optimal path from V2. 

If the optimal path from V goes initially along HCA edge Ei, (note that it will not go along E2 
because of the naming convention above), the paths treat the edge somewhat as if it were a road. Let P be the 
first point on the optimal path from V, which will be the point at which the path exits the HCA interior toward 
the goal. A vertex/edge-following boundary and a vertex/edge-crossing boundary are associated with from V 
with respect to edges E; and E2 respectively. The vertex/edge-crossing boundary is a ray with vertex V lying 
inthe HCA exterior such that the ray and the first leg of the optimal path from V form a Snell’s-Law crossing 
of HCA edge E2 (see Lemma V-7.2). This type of boundary separates paths which go to vertex V and then 
along edge Ei from those that go directly to Ey and follow along it. The vertex/edge-following boundary is a 
special case of the vertex/edge-crossing boundary where the Snell's-Law angle of the ray with edge Ej is the 
critical angle 0. (see Lemma V-7.3). These boundaries are labeled 1 in Figure 28. The vertex/edge-crossing 
boundary separates paths which go to a vertex V and then cut into the HCA interior from those that cross edge 
E; into tlie interior. In Figure 28, these boundaries are labeled 2. 

Also occurring is an edge-following/goal boundary which is a parabola with the goal point as 
focus and directrix perpendicular to a line from P at an angle 7/2 + Qc, lying a distance d away from P where 
d is the cost of an optimal path from P. This type of boundary separates paths which go to edge Ei and follow 
the edge fron: those which go directly to the goal. (See Lemma V-7.4) Figure 28 has these type of boundaries 
labeled 4. Additionally, a vertex/goal boundary occurs which is similar to the road-end/goal boundary of the 
road segment case. This boundary begins at the point at which the edge-following/goal boundary intersects 
the vertex/edge-following boundary, and is a hyperbola segment with V and G being the foci, and the hyper- 
bolic constant being the cost of the optimal patli from V (see Lemma V-7.5). Figure 28 labels this type of 
boundary 3. This boundary may continue indefinitely, or it may intersect the vertex/edge-crossing boundary 
emanating from V. lf these two intersect, both terminate at the point of intersection and a third boundary dis- 


cussed below begins. 
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For each HCA vertex V for which the optimal path from V goes initially into the HCA interior, 
a pair of linear vertex/edge-crossing boundaries will occur, just as in the interior-goal, low-cost case. These 
boundaries separate points whose optimal paths enter the HCA through a hidden vertex from those which enter 
through a hidden edge. Each boundary is constructed by extending a ray from V into the HCA exterior such 
that the ray and the first leg of the optimal path from V forin a Snell's-Law crossing of E1 and E2 respective- 
ly. Ifin addition the vertex/goal boundary associated with vertex V} intersects the vertex/edge-crossing bound- 
ary emanating from Vp associated with edge E}, a third boundary begins. If the first point P along the optimal 
path from V is an HCA vertex, the boundary will be an edge-following/goal boundary, a parabola, as discussed 
above. If P is an interior point ofan HCA edge, the boundary will a more general type of curve similar in shape 
to a parabola, called an edge-crossing/goal boundary (see Lemma V-7.6) In Figure 28, these type of boun- 
daries are labeled 5. A vertex/goal boundary also occurs, beginning at the point at which the edge-crossing/goal 
boundary intersects the vertex/edge-crossing (or edge-following) boundary associated with edge Ej; . 
Whenever an interior boundary (see below) intersects a hidden edge of the HCA, an exterior boundary begins, 
called an opposite-edge boundary (see Lemma V-7.8 and Figure 28 boundary labeled 7). Opposite-edge boun- 
daries separate paths which cross an edge into the HCA interior and then go across the HCA to exit across a 
second, visible edge, from those which cross the same first edge into the HCA but exit across a third, visible 
edge. Just as in the high-cost, exterior-goal case, these boundaries may intersect and new opposite-edge boun- 
daries begin, but in this case they are of only one type and separate paths which cross one pair of edges from 
those which cross another pair. 

There 1s only one type of boundary in the interior of a low-cost, exterior-goal HCA. It begins at 
a visible vertex which is not directly connected to any other boundaries, and separates points whose optimal 
paths cross oue visible edge incident to the vertex from those which cross the other visible edge. Because of 
its similar boundary type in the high-cost exterior-goal case, it is called a visible-edge boundary (see Lemma 
V-7.7 and the boundary labeled 6 in Figure 28). Just as in that case, the interior boundaries may intersect and 
generate new boundaries, which are also visible-edge boundaries. Whenever a visible-edge boundary inter- 
sects a hidden edge. the visible-edge boundary terminates and an opposite-edge boundary begins in the HCA 


exterior. Both the visible-edge boundary and the opposite-edge boundary types are similar in shape to hyper- 
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bola segments, although their algebraic form is not expressible in closed form. These boundaries typically 


have very little curvature. 


B. A UNIFYING VIEW OF REGION BOUNDARIES 
The boundaries associated with eacli terrain feature and the homogeneous-behavior regions they separate 
can be viewed in a more unified manner. This view will provide the basis for a key step in the algorithm 
presented in Chapter VI which merges optimal-path maps for isolated terrain features into consolidated op- 
timal-path maps. 
1. Cost Functions of Regions With Respect to Region Roots 

The cost of optimal paths from each start point in the plane is a function of the location of the start 
point. In other words, there is a cost function of X and Y which characterizes the entire map. Consider the 
region in the vicinity of the goal, for whicli the goal is the region root. Cost is proportional to distance from 
the goal, in the absence of intervening terrain, so iso-cost contours form circles about the goal. This cost func- 
tionis an inverted cone with vertex at the goal-point, or the upper half of a cone as defined in classical geometry. 
In any homogeneous-behavior region with a point as its root, there will be some additional cost of the optimal 
path from the root to the goal. For each region whose root is a single point then, the cost function in the region 
will be conical with respect to a vertical axis through the point. The vertex of the cone representing the cost 
function will be shifted upward on the cost axis by the amount of the cost of an optimal path from the root. 

Another type of region root is an edge along which paths travel en route to the goal, for example, a 
road segment (see Figure 29). In the discussion above regarding road segments, it was noted that the path from 
a point whose optimal path enters a road to travel along it does so at the critical angle O. = sim (C/C). 
where C; is the cost of travelling a unit distance by road and Cp s the cost of travelling a unit distance in back- 
ground terrain. Also, therefore, the cost of travelling from the point of entrance onto the road PE to the point 
of exit from the road Px is C,-IPEPx! = Cpsin(Oc)IPEPXI. 

The cost of travelling from point S to the road and along the road to the point of exit Px is then ISPEglCe 
+ IPEPXIChsinm(0.) = CHUSPEl + IPEV xIsin(0.)). Consider a right triangle with hypotenuse PrPx. with one leg 
a continuation of SPg to the other side of the road from S to point Q. Now IPEQI = IPEPxlsin( Op), so the cost 


of travelling from S to Pg and along the road to Px ts Ch(ISPEI + IPEQI) = CHSQI since S. Pg, and Q are colinear. 
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Figure 29 


Cost Function for Road Segment 
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Thus, the cost from any point S to move to a road and travel along it to some point Px is proportional to the 
distance from S to a line at angle 0. with the road and passing through Px. But by this description, S describes 
a plane which intersects line QPx lying in the plane of the map, sucli that the slope of the plane in tbe gradient 
direction is CelSQI/ISOI 2 Cp. So the cost function associated with a length-wise-travelled edge is a plane. 

A third type of region root is an edge which paths cross, obeying Snell’s Law as they do so. As each 
path crosses the edge, it enters a region where the cost function becomes proportionally greater or less than 
before. But each edge which is crossed according to Snell’s Law perfonns a transformation on the current cost 
function, or intuitively speaking, distorts the cost function. The cost function associated with a Snell’s-Law 
edge is therefore a distortion of the cost function associated with the parent of the edge in the optimal-path 
tree. Thus there are two cost functions associated with Snell’s-Law edges, one where the cone of a point-type 
root is transformed by the edge resulting in a distorted cone, and one where the plane of a road-type root is 
transformed by the edge, resulting in a plane. For regions with conical cost functions, paths which crossed into 
it from a region with a lower cost would have a cost function which was a flattened “cone”. Paths crossing into 
it from a region with a higher cost would have a cost function which was a "cone" with greater curvature. For 
regions with planar cost functions, higher-cost adjacent regions would have a more sloped cost function, while 
lower-cost adjacent regions would have a less sloped cost function. 

There are any number of "higher-order" cost functions associated with Snell's-Law edges ending in 
a point. For example, paths could cross three edges enroute to a point. So it does not appear to be possible to 
derive a finite number of analytic characterizations of cost functions for all varieties of Snell’s-Law edges. 
Note, however, that although a cost function may be transformed by any number of Snell’s-Law edges. it has 
its basis in either a point or a linearly-traversed edge root, so there are really only two general classifications 
of Snell’s-Law cost functions, those for n crossings rooted in a point, and those for n crossings rooted in a 
linearly-traversed edge. Once a sequence of region roots leads back to a point or a traversed edge, a fixed cost 
is associated with the point or the goal end of the edge. which is the cost from that point to the goal, and so no 
other previous information about cost functions remains relevant. 

A river edge can also be a region root. However, since a river edge only adds a fixed amount to the 
cost of paths which cross it, it serves only to shift vertically by a fixed amount whatever cost function occurs 


in the region on its near side, and so cannot be said to have a characteristic cost function of its own. The final 


type of region root is the degenerate one, the null lst, adopted by convention to represent regions which have 
no feasible paths, for example, obstacle interiors. Since the cost of a path in the degenerate region is infinity, 
the cost function will be considered undefined. 

Since these are the only types of region roots which occur in the terrain defined for this research, 
there are only three general types of cost functions: cones, planes, and various orders of distorted cones, depend- 
ing respectively on whether the region bas a point as its root, a linearly-traversed-edge or one or more Snell’s- 
Law edges ending in a linearly-traversed edge as its root, or finally a Snell's-Law edge as its root leading to 
one or more Snell's-Law edges and a point. 

2. Boundaries Between Regions as Intersections of Cost Functions 

The occurrence of many of the simpler types of boundaries can now be explained in terms of the cost 
functions of the region roots for regions which tbe boundary separates. Since at a boundary between two 
regions, the cost function for both regions applies, it must be that the boundary is the projection on the XY 
plane of the intersection of the two cost functions. The intersection of two cones with parallel axes is, accord- 
ing to basic analytic geometry, a hyperbola, and so it becomes clear why the boundary between two regions 
with points as roots is always a hyperbola. 

The boundary between a region whose root is a point and a region whose root is a road-segment was 
determined in Section A3 above to be a parabola. Since the slope of the plane which is the cost function of the 
road-segment's region was shown above to be the cost rate of the background, and the slope of the cone is also 
the cost rate of the background, we bave the condition which specifies in intersecting a plane with a cone that 
the intersection is a parabola. 

The intersection of two planes is a line, so the boundary between regions which both have linearly- 
traversed edges as roots is a line segment. For example, the hidden-edge merging-path boundary of a high- 
cost, external-goal HCAÀ is such a boundary, and as shown in Section Ada above is indeed a line segment. 

The more complicated boundaries involving one or more Snell 's-Law edges ending in a point also 
are consistent with this view. although the mathematics involved in computing the intersections of general- 
ized shapes is complex. Boundaries involving Snell's-Law edges ending in a linearl y-traversed edge are of the 
same types as those involving single linearly-traversed edges. Since there are three general types of cost func- 


tions, and each boundary can be described as the intersection of two cost functions, there are six non-redun- 
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dant ways that two cost functions may intersect, as in Table 5. Each entry in the last row and the last column 
depends on the number of edges crossed by the region root, and will be different for different numbers of 
edges. For some cases, a boundary listed as a parabola, hyperbola, or distorted parabola or hyperbola will 
degenerate to a straight line. 

A view which takes into account the nature of the cost functions associated with regions which are 
separated by boundaries leads to a more unified approach to the derivation of the analytical forms of the boun- 
daries. This view will become important in the process of merging several single-feature optimal-path maps 
discussed in Chapter VI, since there will be too many possible cases of region intersections to derive each 
analytical form case by case. The above six forms will provide the basis for a general solution to the problem 


of merging OPM’s. 
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TABLE 5 
BOUNDARY TYPES BY REGION ROOT PAIRS 


EE RON R 


(cone) (plane) (distorted cone) 
point hyperbola parabola distorted 
(cone) hyperbola 
linearly-traversed edge parabola line distorted 
(plane) parabola 
S-L edge to pt distorted distorted distorted 
(distorted cone) byperbola parabola hyperbola 
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VI. ALGORITHMS FOR OPM CONSTRUCTION BASED ON SPATIAL 
REASONING 


A. OPTIMAL-PATH TREE CONSTRUCTION 

The first step in constructing an optimal-path map is to build an optimal-path tree (OPT). A straightfor- 
ward way to do this is presented here, although a more efficient way would be to build the OPT during the ex- 
ecution of an algorithm such as recursive-wedge decomposition or the continuous-Dijkstra algorithm. A set 
of optimal paths from the goal point to each terrain-feature vertex is computed using any point-to-point path- 
planning algorithm. The turn points of these optimal paths are then sequentially inserted into the OPT by scan- 
ning each path list from the goal point to its start point as the OPT is traversed from its root (the goal) through 
its internal nodes, matching nodes of the tree with turn points of the path. 

As the insertion algorithm traverses the OPT, a pointer identifies the current node. A pointer also iden- 
tifies the current element of the path list. If the current node has a child node which matches the current ele- 
ment of the path list, the child node becomes the current node and the next element on the path list becomes 
the current one. If the current node has no child node which matches the current path-list element, a new node 
is created which matches the path-list element and whose parent is the current node. Then as before, the child 
node becomes the current node and the next path-list element becomes the current one. When the end of the 
path list is reached, the insertion is complete. When all the terrain-feature-vertex optimal paths have been in- 
serted into the OPT, one final node representing the empty path list (for "start" points with no feasible paths, 
as for example in the middle of an obstacle) is inserted as a child of the root node and the initial OPT is com- 


plete. 


B. BASIC ALGORITHMS FOR ISOLATED TERRAIN FEATURES 

First, we present algorithms to construct planar partitions for four types of isolated single terrain features, 
given optimal-path trees. The planar partition, along with its optimal-path tree, comprises an optimal-path map. 
An algorithm is presented for obstacle. river segment, and road segment primitives, and for each of the four 


cases associated with homogeneous-cost areas (HCA). 
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1. An Algorithm for OPM Construction for A Single Obstacle 

For a single obstacle in a homogeneous-cost background (see Figure 17), the algorithm to construct 
the optimal-path map with respect to a certain goal point, given the optimal-path tree, is straightforward. The 
OPT for a single obstacle will have three branches from the root, one of which will consist only of the empty 
node. Each of the other two branches will consist of one chain of nodes representing vertices on one side or 
the other of the obstacle. The algonthm begins by taking the obstacle edges as the starting set of homogeneous- 
behavior boundaries. Then it constructs all the shadow boundaries by traversing down the two branches of the 
optimal-path tree whose nodes represent vertices on opposite sides of the obstacle, creating a shadow bound- 
ary for each edge of the tree until it finds the leaf node of each branch. Then it constructs the opposite-edge 
boundary starting with the hyperbola generated by the two vertices of the opposite edge and sweeping away 
from the goal. Each time the current segment of the opposite-edge boundary intersects a shadow boundary, a 
new pair of foci is determined, and the new hyperbola segment is constructed. The algorithm is finished when 
the opposite-edge boundary does not intersect any more shadow boundaries. 

Table 6 (on two pages) shows the algorithm for construction of a single obstacle OPM. Algonthms 
are presented using standard procedural conventions as in Chapter II, with natural-language explanations sub- 
stituting for rigorous notation where possible without ambiguity. The input to each algorithm is a representation 
of the terrain feature and an optimal-path tree, representing the optimal paths from each terrain-feature ver- 
tex. The doubly-connected-edge-list (DCEL) data structure presented in Chapter I, Section A is used to rep- 
resent the planar partition. We assume that low-level algorithms are available to manipulate the DCEL, for 
example, insert-into-dcel. Assume also that specifying an optimal-path tree node is equivalent to specifying 
the coordinates of the vertex represented by it, as well as the cost of the optimal path from the vertex to the 
goal. 

The procedure add-obstacle-opposite-edge-bdry is called by the algorithm to construct the opposite- 
edge boundary as it lies outward from the CO It does this by finding, if they exist, points of intersection 
with the shadow boundaries from the two vertices which serve as the foci of the hyperbola which is the active 
portion of the opposite-edge boundary, and choosing the one which occurs closest to the obstacle. Both the 
shadow boundary and the hyperbola are truncated at this point, and new foct and a new hyperbola are deter- 


mined. This hyperbola becomes the active portion of the opposite-edge boundary, and new shadow boundaries 
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TABLE 6 
OBSTACLE OPM ALGORITHM 


algorithm single-obstacle-opm: (Algorithm VI-1) 
input: Optimal-Path Tree with root node N 
and associated obstacle edge-list O; 
output: Optimal-Path Map M (a DCEL) 
and modified Opumal-Path Tree N; 
purpose: to construct an OPM for a single obstacle; 
| 
M :- empty dcel structure: 
while (O is not empty) /* insert obstacle edges into DCEL. */ 
| 
insert-into-dcel( M.First edge of O); 
O :=0 less first edge of O; 


Nprev EUN /* initialize Nprev to Goal. "m, 
j:= 1; 
for each child-node of N /* construct shadow boundaries. */ 


| 
IN er = child-node(N): 


if Ncurr has a child node /* ie, if node 1s not a leaf node. */ 
until Neurr has no child nodes /* ie, tf node ts a region root. */ 
{ /* traverse to bottom of this branch. */ 
Nprev := Nceurr; 
Bdry := Line NcurrNprev i ie, ray starting at Neurr and m 
less ray NeursNprev ; /* lying away from Norev. */ 
insert-into-dcel(M,Bdry): /* add shadow boundary to DCEL. */ 
| 
Opposite-edge-vertexj := Neurr: /* note: there are exactly two such vertices. */ 
Ji=j +1; 
| 
| 
iom: to2 


| 
Focus; :- Opposite-edge-vertex;; 
Costj := cost of optimal path from 
Opposite-edge-vertex;; 
| 
add-obst-opp-edge-bdry /* construct opp-edge bdry. */ 
(Focusi,Costi,Focus2,Cost2,M,N); 
| /* end of single-obstacle-opm Algorithm */ 
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TABLE 6 (CONTINUED) 
OBSTACLE OPM ALGORITHM 


procedure add-obstacle-opposite-edge-boundary 
input: coordinates and optimal costs froni opposite-edge 
vertices, shadow bdrys represented in DCEL M, aud optimal-path tree N; 
output: revised DCEL M; 
purpose: to build the opposite-edge bdry by concatenating successive hyperbola segments; 
| 
ShadBdry| := shadow bdry from Vertex; 
ShadBdry2 := shadow bdry from Vertex2; 
repeat until. neitlier shadow boundary intersects the hyperbola; 
Bdry := segment of hyperbola branch such that /* initialize Bdry to initial leg starting at */ 
Focus, :- Vertexi, Focus? :- Vertex», /* obstacle opposite-edge. */ 
hyperbolic constant := abs(Costt - Cost2), 
and segment lies away from goal: 
Intersect := point of intersection of Bdry 
with shadow bdry from Focus}; 
Intersect2 := point of intersection of Bdry 
with shadow bdry fron Focusz: 
if at least one shadow bdry intersects Bdry 
| 
j:zj which minimizes length from the beginning 
of Bdry to Intersect; ; 
Bdry := portion of Bdry between its beginning 
and Intersect; : 
insert-into-dcelM,Bdry); /* add current segment of opp-e. bdry to DCEL. */ 
Bdry := segment of hyperbola branch starting  /* get next segment of opposite-edge bdry. */ 
at Intersect; such that Focus; := parent-node(Focusj), 
Costj = Cost of Focus, hyperbolic constant 
:= abs(Cost¡ - Cost2), and segment lies away from goal; 


ShadBdryj := shadow bdry from Vertex;: /* substitute new shadow bdry from new focus. */ 
else insert-into-dcel(M,Bdry); /* add last segnient of opp-edge bdry to DCEL */ 
| 

) /* end of add-obstacle-opp-edge-boundary */ 
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are checked for intersections. When no intersections are found, the procedure is finished and the opposite-edge 
boundary is the concatenation of all the hyperbola segments. 

The algorithm of Mitchell [Ref. 4] also builds an optimal-path map for an obstacle. It allows for mul- 
tiple obstacles, as does Algorithm VI-1 used in conjunction with Algorithm VI-9 below, and also depends on 
the analytical characterization of homogeneous-behavior boundaries as line segments or sequences of con- 
nected hyperbola segments. His algorithm uses the notion of generalized visibility to build successive sub- 
OPMs. It merges OPMs using Voronoi-diagram construction methods from computational geometry, while 
algorithm VI-9 must use a more ad hoc approach, since Voronoi diagrams for the more general terrain fea- 
tures we consider are not available. 

2. An Algorithm for OPM Construction for A Single River Segment 

The algorithm to construct the planar partition for a single river segment is similarly straightforward 
(see Figure 18). In this case, exactly two shadow boundaries, at most two river-crossing boundaries and one 
opposite-edge boundary need to be constructed. If the river-crossing boundaries intersect, the opposite-edge 
boundary will begin at their point of intersection. Otherwise, no opposite-edge boundary will exist. A change 
from the obstacle algorithm is the addition to the optimal-path tree of edges which are crossed by paths, since 
these are homogeneous-behavior region roots. Table 7 shows the river-OPM construction algorithm. 

As discussed in Chapter I, it is possible to model rivers, as well as obstacles and lus; as 
homogeneous-cost areas, and so Algorithms VI-4 and VI-6 could be used instead of Algorithms VI-1, VI-2, 
and VI-3. But these first three algorithms are simpler. 

3. An Algorithm for OPM Construction for A Single Road Segment 

The algorithm for a single road segment is somewhat more complicated, although still straightfor- 
ward (see Table 8). As discussed in Chapter V (see Figures 19, 20, and 21), the boundaries which will exist 
for a road segment are determined by the positioning of the characteristic wedge with respect to the road ver- 
tices. Therefore, top-level decision logic for the algorithm is based on the position of the characteristic wedge. 
Procedure construct-rd-bdry is called to compute each specific boundary. 

4. An Algorithm for A Single Convex High-Cost Exterior-Goal Homogeneous-Cost Area 
The algorithm to compute the planar partition for high-cost area with an external goal is called hca- 


opm-high-ext (see Table 9). The equations for each boundary can be found in Appendix A in the Lemma cor- 
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TABLE 7 
RIVER-SEGMENT OPM ALGORITHM 


algorithm single-river-segment-opm (Algorithm VI-2) 
input: Optimal-Path Tree with root node N and associated river edge-list R with cost Ci; 
Output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct an OPM for a single isolated river segment; 


| 
M := empty dcel structure; 


for Ncurr := each river-vertex child-node of N /* construct shadow boundaries */ 
| 
Bdry := Line NeurrN less Half-line NeurrN; /* ie, half-line starting at Ncurr, away from goal */ 
insert-into-dcel(M,Bdry); /* add shadow boundary to DCEL. */ 
) 
for j :21t02 


| 

Focus; :- River- Vertex; 

Cost; := cost of optimal path from River-Vertex;; 

Bdryj := segment of hyperbola branch with foci /* river-crossing bdry for each river vertex. */ 
Focus; and Goal, hyp constant = abs(Costj - Cr), 
such that branch is closer to Focusj; 


if Bdryj intersects river segment /* if so, find intersection point. */ 
Intersect; := intersection point; 
else 
Bdry; :- null list; /* if not, nver-crossing bdry does not exist. */ 
} 
if Bdry| is not null /* (neither bdry or both bdrys will be null) */ 


Intersecti,2 :— intersection of Bdry: and Bdry? ; 
Bdry1 := Bdry| from Intersecti to Intersecti,2 ; 
Bdry2 := Bdry2 from Intersect2 to Intersect) 2 ; 


insert-into-dcel(M,Bdry 1); /* add river-crossing bdry 1 to DCEL. */ 
insert-into-dcel(M,Bdry2); /* add river-crossing bdry 2 to DCEL. */ 
Bdry := segment of hyperbola branch with /* find opposite-edge bdry. */ 


Focus} and Focus2, hyperbolic constant = 

abs(Cost; - Cost2), such that branch is closer 

to the higher-cost focus, with starting point at 

Intersect1,2, lying away from goal; 
River-edge:1 2 := Line from Intersect, to Intersectz2 ; 


insert-into-opt(N,River-edge¡ 2); /* add river-crossing edge to Optimal-Path Tree. */ 
) 

else 
Bdry := segment of hyperbola branch with /* find opp-edge bdry if no river-crossing bdrys. */ 


Focus; and Focus2, hyperbolic constant = 

abs(Cost1 - Cost2), such that branch is closer 

to the higher-cost focus, with starting point at 

intersection of hyp and river, lying away from goal; 
insert-into-dcel(M,Line from Focus to Focus2); /* add river edge as bdry */ 
insert-into-dcek(M,B dry); /* add opposite-edge bdry to DCEL */ 
} /* end of single-river-opm Algorithm */ 
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TABLE 8 
ROAD-SEGMENT OPM ALGORITHM 


algorithm single-road-segment-opm (Algorithm VI-3) 
input: Optimal-Path Tree with root node N and associated road edge-list R with cost Cr; 
output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct an OPM for a single, isolated road segment; 
| 
M := empty dcel structure; 
Oc : sin KC Cbackground); /* road critical angle */ 
Wedge-Ray 1 := ray from G intersecting road V1V2 
at Pt A such that ZGAV2 =1t/2 — 0; 
Wedge-Ray?2 := ray from G intersecting road V1V2 


at Pt B such that ZGBV = 70/2 — 06; /* A is oriented to B as V is to V2 (see Chap V)*/ 
if pts A, B, and V1 are ordered "BAV," /* wedge is "inside" V1 so generate boundary */ 

| 

construct-rd-bdry(road-end/travelling, V 1); /* types b,c and d on the V; end. */ 


construct-rd-bdr y(road-end/goal,V 1); 

construct-rd-bdr y(near-side-road-travelling/goal, V1); 

if pts A,B, & V2 are not ordered "V2AB" /* if in addition wedge is not "outside" V2, */ 
construct-rd-bdry(road-travelling/crossing,V 1); /* generate type e bdry on V; end. */ 


) 


else if they are ordered "BVA" /* wedge "straddles" V1 so generate boundary */ 
construct-rd-bdry(road-shadow, V1); /* type g on the V; end */ 
else if they are ordered "V¡BA" /* wedge is " outside" V; so generate boundary */ 


| 
construct-rd-bdry(near-side-rd-travell'g/goal, V2); /* types d on the V2 end and f on the V1 end */ 


construct-rd-bdr y(far-side-road-travelling/goal,V2); 


} , 
if pts A, B, and V2 are ordered "ABV2" /* wedge is "inside" V2 so generate boundary */ 

| 

construct-rd-bdry(road-end/travelling, V2); /* types b,c and d on the V2 end. */ 

construct-rd-bdry(road-end/goal, V2); 

construct-rd-bdry(near-side-road-travelling/goal, V2); 

if pts A,B, & V; are not ordered "V¡BA" /* if in addition wedge is not "outside" V y, */ 

construct-rd-bdry(road-travelling/crossing, V2); /* generate type e bdry on V2 end. */ 


) 

else if they are ordered "AV2B" /* wedge "straddles" V? so generate boundary */ 
construct-rd-bdry(road-shadow,V2); /* type g on the V2 end. */ 

else if they are ordered "V2AB" /* wedge is “outside” V2 so generate boundary */ 


| 
construct-rd-bdr y(near-side-rd-travell'g/goal, V2); /* types d on the V4 end and f on the V2 end. */ 
construct-rd-bdry(far-side-road-travelling/goal,V 1); 
) 
} /* end of single-road-opm algorithm */ 
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TABLE 8 (CONTINUED) 
ROAD-SEGMENT OPM ALGORITHM 


procedure construct-rd-bdry 
input: type of bdry T, vertex V ofroad, DCEL M, Optimal-Path-Tree N, and Wedge-Ray¡ and Wedge-Ray2 
output: revised DCEL M and revised OPT N; 
purpose: construct each road-generated boundary of type T; 
(j := 3-1; /* if i=1, j=2 and if 1=2, j=1, i.e., j is other end */ 
if T = road-end/travelling /* Type "b" boundary */ 

(Bdry1 := Ray with vertex Vi, lying on line ViX, such that Z VjViX = 1/2-4-0.; 

Bdry2 := Ray with vertex Vi, lying on line ViY, such that Z VjViY = 37/2—0,; 


, 


insert-into-dcel(M,Bdry1); /* add road-end/travelling boundary to DCEL. */ 
insert-into-dcel(M,Bdry2); /* add road-end/travelling boundary to DCEL. */ 
} 

else if T = road-end/goal /* Type "c" boundary */ 


( Bdry :z the branch closer to Vi of a hyperbola with foci Vj and Goal, and hyp. constant = cost from 
Vi to Goal via road, starting at point of intersection between hyperbola and type b bdry from Vi; 


insert-into-dcel(M,Bdry); /* add road-end/goal boundary to DCEL. */ 
) 

else if T = near-side-road-travelling/goal /* Type "d" boundary */ 
(if (wedge is not outside Vj) /* wedge is inside Vi & not outside V; */ 


Bdry := segment of parab. s.t. focus — Goal, and directrix Dl Wedge-Ray; with D being IGPI from P 
. (P=A if i=1, else P=B), starts at P, lies away from Goal, ends at inters. with type b bdry from Vi; 
else /* wedge is inside Vj & outside Vj */ 
Bdry := segment of parabola with focus = Goal and directrix = line L, LL. Wedge-Ray; such that L is 
IGVjl from Vj, starting at P := Vj, lying away from Goal, ending at inters. with type b bdry from Vi; 


insert-into-dcel(M,Bdry); /* add near-side-road-trvlg/goal bdry to DCEL. */ 
insert-into-opt (N,PV;,Near-side); /* add travelled road segment to OPT. */ 
insert-into-dcel(M,P Vi); /* add travelled segment as edge bdry to DCEL */ 
} 

else if T = road-travelling/crossing /* Type "e" boundary */ 


{Bdry := ray starting at P and lying along Wedge-Rayi, 
(where P-À if i21 and P-B if i22), lying away from Goal; 


insert-into-dcel(M,Bdry); /* add road-travelling/crossing bdry to DCEL. */ 
insert-into-opt (N,edge PV;,Far-side); /* add road segment which is travelled to OPT. */ 
insert-into-dcel(M,PVi); /* add travelled segment as edge bdry to DCEL */ 
) 

else if T = far-side-road-travelling/goal /* Type "f" boundary */ 


(insert-into-opt (N,V;Vj,Near-side); 
insert-into-opt (N,V;VjFar-side); 
insert-into-dcel (M,line ViVj); /* road-edge boundary added to DCEL */ 
for k := 1 to 2 
(Bdryx := segment of parabola with focus = Goal, and directrix = line L, L1Wedge- 
Rayk such that L is IGVjl from Vi, starting at Vi and lying away from Goal; 


insert-into-dceKM,Bdryx); /* add far-side-road-trvlg/goal bdrys to DCEL. */ 
) 
| 
else if T 2 road-shadow /* Type "g" boundary */ 
( Bdry := ray from Vi along line ViG, lying away from Goal; 
insert-into-dcel(M,Bdry); /* add road-shadow bdry to DCEL. */ 
| 
) /* end of construct-rd-bdry */ 


114 


TABLE 9 
HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


algorithm hca-opm-high-ext (algorithm VI-4) 
input: Optimal-Path Tree N, HCA A with n vertices; 
output: DCEL M, aud modified OPT N; 
purpose: to construct the OPM for a high-cost, exterior-goal HCA. 
| 
fori:=1 ton /* add interior bdry for each vertex. */ 
| 
if edge 1 is visible 
if edge i+1 is visible 
B := value returned by construct-high-ext-hca-bdry(‘visible-edge’ ,i); 


else 
B := value returned by construct-high-ext-hca-bdry(" visible-hidden",i); 
else if edge i is hidden 


if edge i+1 is visible 
B := value retumed by construct-high-ext-hca-bdry("visible-hidden",i-1); 
else 
if edges are on different sides of opposite edge 
B :- value returned by construct-high-ext-hca-bdry("hidden/diverging ",1); 
else 
B :- value returned by construct-high-ext-hca-bdry("hidden/merging" i); 
add B to BdrySet; 
| 
BdrySet := value returned by pair-and-merge-bdrys /* join interior bdrys together. */ 
(BdrySet,"high-ext-hca-interior"); 
form BdryTrees from bdrys in BdrySet; 
for each BdryTree 
| 
find point X at which BdryTree /* there will be exactly one X per tree */ 
intersects an opposite edge; 
B :z value retumed by construct-high-ext-hca-bdry("opposite-edge ", X); 
add B to OEBdrySet; 


fori:=1ton 
if Vi connects a visible and a hidden edge 

| 

if Viis not connected to any interior BdryTree 
add construct-high-ext-hca-bdry("corner-cutting",X) to BdrySet; 

B :- value retumed by construct-high-ext-hca-bdry(" shadow ",i); 

j := other vertex of E; 

while Ej is not an opposite edge /* work around the HCA creating shadow */ 
i /* bdrys until the opposite edge is found. */ 
B := value returned by construct-high-ext-hca-bdry("shadow",j); 
j := other vertex of Ej 
| 


B :- value returned by pair-and-merge-bdrys /* join opposite-edge bdrys together. */ 
(OEBdrySet,"high-ext-hca-exterior"); 

add B to BdrySet; 

for all B € BdrySet 
insert-into-dcel(M,B); 

} /* end of hca-opm-high-ext */ 
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TABLE 9 (CONTINUED) 
HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


procedure pair-and-merge-bdrys /* join connecting bdrys together. */ 
input: BdrySet, and type of region; 
output: revised BdrySet; 
purpose: to take an initial set of boundaries, pair the ones which first intersect each other, and 
propagate a new bdry from each intersected pair, continuing until all appropriate bdrys are joined. 


while BdrySet is changing 
| 
PairedBdrySet := BdrySet; 
while PairedBdrySet is changing 
| 
for all B;;€ PairedBdrySet where Bi,j is unmarked 
discard Bi, from PairedBdrySet; 
add Bi,j from BdrySet to PairedBdrySet; 
intersect Bij with Bh,¡ and truncate both; 
add Bp, ^* and B;;"""* to PairedBdrySet; 
intersect Bij with Bik andtruncate both; 
add B; "* and Bj. ^ :— to PairedBdrySet; 


for all Bi,;;€ PairedBdrySet 
discard all but the shortest B; j from PairedBdrySet; 
unmark all bdrys in PairedBdrySet; 
for all Bi,; and Bj,k€ PairedBdrySet such that Bi,j adjoins Bj,x 
mark B;,j and Bjk; 
for all Bj jand Bj xe PairedBdrySet such that B;j adjoins Bj,x 
add Bix to PairedBdry Set; 
BdrySet := PairedBdrySet; 


} /* end of pair-and-merge-bdrys. */ 
y. 
e $ c à 
- E i + E MEME e-- 
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TABLE 9 (CONTINUED) 
HIGH-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


procedure construct-high-ext-hca-bdry 
input: type of bdry T; index of vertex 1; 
output: Bdry, the resulting boundary; 


/* provides methods to construct each type of */ 
/* bdry of high-cost, exterior-goal HCA. */ 


purpose: to construct a boundary generated by vertex 1 of type T; 


| 
if T 2 "visible-edge" 

Bdry := curve as specified in Lemma V-4. 1; 
if T = "visible-hidden" 

Bdry := curve as specified in Lemma V-4.2; 
if T = "merging" 

Bdry := curve as specified in Lemma V-4.3; 
if T z "diverging" 

Bdry := curve as specified in Lemma V-4.4; 
if T z "hca-edge" 

Bdry := curve as specified in Lemma V-4.7; 
if T z "shadow" 

Bdry := curve as specified in Lemma V-4.8; 
if T = "opposite-edge" 

Bdry := curve as specified in Lemma V-4.9; 
if T z "corner-cutting" 

Bdry := curve as specified in Lemma V-4.10; 
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/* end of construct-high-ext-hca-bdry */ 


responding to the boundary type (see also Figures 23, 24, and 25). Each vertex of such a HCA is associated 
with an internal boundary, whose character depends on whether the edges incident to the vertex are visible or 
hidden (and for vertices on two hidden edges, on whether the vertices nearest the goal for each edge have op- 
timal paths which go in the same, or different directions around the HCA, called merging or diverging paths 
respectively). These boundaries are computed first, and then procedure pair-and-merge-bdrys constructs a 
network (or networks) of interior boundaries which is connected to the initially-computed boundaries. This 
procedure pairs boundaries which intersect, and then plots a new boundary which has an endpoint at the point 
of intersection of the paired boundaries. It continues pairing boundaries and plotting new ones until all the 
boundaries are joined together on both ends or intersect an edge of the HCA. Note that deciding which ad- 
jacent boundaries should be paired together is not simple, and it may take several iterations for the procedure 
to settle on a correct configuration. 

The interior boundaries are then joined into trees, and since each interior boundary tree intersects an 
opposite edge exactly once, this can serve to begin generation of the external opposite-edge boundaries. In 
contrast to obstacles, there can be several HCA opposite edges and opposite-edge boundaries. Comer-cutting 
boundaries are indicated when an interior boundary associated with a vertex actually begins, not at the vertex, 
but somewhere along the boundary. The algorithm next checks for this situation, which can only happen with 
respect to a vertex joining a hidden and a visible edge. This type of vertex is also a good place to begin generat- 
ing shadow boundaries. Finally, procedure pair-and-merge-bdrys is again used, this time with the exterior 
shadow and opposite-edge boundaries. 

Figures 30, 31, and 32 illustrate the state of procedure pair-and-merge-bdrys at various intermediate 
stages in its execution for the example HCAs of Figures 23, 24, and 25 respectively. Edges of the HCAs are 
numbered, and boundaries are labeled "i,j", where i and j represent the edges crossed by paths on either side 
of the boundary. Boundaries which are paired with another boundary at each stage are noted by an asterisk. 
Boundaries which are stored in the data structure PairedBdrySet are noted in the figures as dark lines. Figure 
30a, 31a, and 32a show the interior boundaries associated with each terrain-feature vertex at the beginning of 
the algorithm (beginning at the vertex or associated short-cutting point, extending indefinitely into the inte- 
rior and then beyond. The current set of interior-boundary trees is also shown, with each node labeled by the 


boundary it represents. 
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Construction of HCA Interior-Boundary Tree Example 3 
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Consider, for example, Figure 31. Figure 31b shows the state of PairedBdrySet with respect to the 
HCA after the first pass through the inner loop ("while PairedBdrySet is changing”), where each boundary 
"i,j" in the initial set of boundaries is intersected with the two adjacent boundaries, and the shortest version of 
"ij" is retained in PairedBdrySet. Those boundaries which pair up with an adjacent boundary are marked with 
"*" In Figure 3 1b, "1,6" pairs with "5,6" and "1,2" pairs with "2,3". "4,5" and "3,4" were not marked, and so 
are going to be replaced in PairedBdrySet by the full versions of their respective boundaries at the start of the 
next pass through the inner loop. After the second pass through the inner loop, all boundaries are marked as 
in Figure 31c, so on the next iteration no changes to PairedBdrySet will be made, so the "while changing" con- 
dition will fail, ending the inner loop. 

AS the outer loop ("while BdrySet is changing") finishes its first pass, new boundaries are generated 
from each intersection point of paired boundaries, and these boundaries are placed, unmarked, into Paired- 
BdrySet, which fepiscesiBdrySet This situation is reflected in Figure 31d. Figure 3le reflects the state of 
PairedBdrySet after the outer loop bas started its second pass, and the inner loop has run until it stabilizes 
again. Note that some boundaries which were paired after pass one, i.e., "4,5" and "3,4", are in fact intersected 
by second-level boundaries instead, and so the truncated versions of the boundaries need to be retracted from 
PairedBdrySet and the full versions put back into PairedBdrySet for further interaction with second-level boun- 
daries. This illustrates why such this procedure is complicated, because we are not able to tell with a single 
pass which boundaries will be paired. Boundary "1,4" is now propagated from both directions from the inter- 
section points of "4,5" and "1,5" as well as "1,3" and "3,4". It is truncated at both ends and paired with itself, 
after which the configuration is stable. Thus BdrySet will not change further, so the outer loop will halt with 
BdrySet as illustrated in Figure 31f. At each stage, the interior-boundary trees are built up until, in Figure 31f, 
a single tree results. 

In algorithm hca-opm-high-ext, it is assumed initially that there is an opposite point, i.e., a point on 
the hidden side of the HCA where two optimal paths go in opposite directions around the HCA. Further, this 
assumed opposite point is initially considered a vertex for the purposes of the algorithm. Figure 30 shows a 
situation where the algorithm leads to the conclusion that the opposite point does not exist after all, and so 
there is no interior boundary incident to it, because there is shortcutting of paths from the outside of the HCA 


across the HCA to the goal. The figure also shows a situation where there is more than one interior-boundary 
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tree. There is one exterior opposite-edge boundary incident upon an HCA edge associated with each interior- 
boundary tree. It has one endpoint at the point at which a boundary of the tree intersects an opposite edge. 

5. An Algorithm for OPM Construction for A Single Convex High-Cost, Interior-Goal 
Homogeneous-Cost Area 

A much different algorithm is needed to construct boundaries for the case of a high-cost HCA with 
an interior goal point (see Figure 26). The existence of interior boundaries are more predictable without the 
need for the iterative checking as in the high-cost, exterior-goal HCA case. It is still necessary, however, to 
check the intersections of various boundaries and truncate them appropriately, and insert portions of edges 
into the optimal-path tree, which is done at the algorithm’s conclusion. (See Table 10.) 

The algorithm proceeds by looking at each HCA vertex in tum, and determining by observing its op- 
timal path whether it is a hidden or a visible vertex. If it is a hidden vertex, the path from the vertex will travel 
along an edge of the HCA before cutting into the interior, while if itis a visible vertex, the path will go direct- 
ly to the goal. If it is hidden, several interior boundaries and one exterior shadow boundary are generated, as 
well as possibly an opposite-edge boundary. If it is visible, only one exterior boundary, a visible-edge bound- 
ary, is generated. 

It is necessary to insert portions of edges into the optimal-path tree according to the traversal charac- 
teristics of optimal paths across or along them. For example, it is possible for a portion of an edge from one 
vertex to act like a road, where paths leave the HCA interior to travel along the lower-cost edge, and then cut 
back in to the HCA when nearer to the goal. Thus the first portion of the edge would be the root of a 
homogeneous-behavior region characterized by paths crossing from the interior to the exterior and travelling 
along the edge, and the next portion of the edge would be the root of another region characterized by paths 
crossing from exterior to interior. All this information is not available when processing each individual ver- 
tex, however, so edges which may become region roots are stored temporarily, and at each step when infor- 
mation is gained which could rule out portions of edges as roots, that information is stored as a "mask", which 
is used to mask out portions of edges. At the conclusion of the algorithm, these edges and masks are processed 
to determine exactly which portions of edges belong as region roots in the optimal-path tree. Also done at the 
conclusion of the algorithm is the intersecting of opposite-edge and shadow boundaries and plotting of new 


boundaries in the HCA exterior, much like in the interior of a high-cost, exterior-goal HCA. 
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TABLE 10 
HIGH-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


algorithm hca-opm-high-int (algorithm VI.5) 
input: Optimal-Path Tree with root N, HCA A with n vertices; 
output: DCEL M and revised OPT N; 
purpose: construct an OPM for high-cost, interior-goal HCA; 
(fori:=1 ton 


{if P # Goal, where OPL(V;) 2» [P | OPL(P)] /* i.e., if path from V lies on edge E2 of HCA */ 
{ /* with other edge called E, an interior linear */ 
E2 := edge containing Vi¡P; /* bdry and two parabolic bdrys are formed, */ 
E, := other edge incident to Vi; /* and an exterior shadow boundary is formed. */ 


B; :- value returned by construct-high-int-hca-bdry("hidden-edge", Vi); 
B2:- value returned by construct-high.-int-hca-bdr y("hidden-edge/goal", Vi); 
B3 := value returned by construct-high-int -hca-bdry(" visible-edge/goal",P); 
B4 :- value returned by construct-high-int-hca-bdr y( "shadow" ,P); 
add B4 to ExtBdrySet; 
intersect B1, B2, B3 & add B1" to IntBdrySet; /* they intersect at the same point. */ 
if B2 intersects E1 at some pt X 
{truncate B2 at X; 
add B2"™"® to IntBdrySet; 
insert-into-opt(N,V¡X,"Near-side"); 
add Ej and Mask(ViX) to VisEdgeSet; 
Bs := value returned by construct-high-int-hca-bdry("corner-cutting",X); 
add Bs to ExtBdrySet; 
} /* if paths from two vertices go opposite ways */ 
else if (OPL(Vi) Z OPL(Vi+1) and OPL(Vi+1) Z OPL(Vi))  /* around HCA, edge is opp edge. */ 
(Be := value retumed by construct-high-int-hca-bdry("interior-opposite-edge", Vi, Vi+1); 
intersect Bs with B2 & add Bg!" '* to IntBdry Set; 
X := pt where Be intersects E}; 
B7 := value returned by construct-high-int-hca-bdry("exterior-opposite-edge", Vi, Vi+1); 
add B7 to ExtBdrySet; 
insert-into-opt(N,V;¡X,"Near-side"); 
insert-into-opt(N,XVi, |," Near-side"); 
) 
else 
(insert-into-opt(N,E;,"Near-side"); 
add B2""^* to IntBdrySet; 
) 
if B3 intersects edge E2 at X 
(insert-into-opt(N,V;¡X,"Near-side"); 
truncate B3 at X; 
add B3"""" to IntBdrySet; 
) 
) 
else /* i.e., if path goes from V directly to Goal. */ 
{B := value returned by construct-high-int-hca-bdry("visible-edge",Vi); 
add B to ExtBdrySet; 
add E, and E2 to VisBdrySet; 
) 
post-process-high-int-hca-bdrys, 
} /* end of hca-opm-high-int */ 
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TABLE 10 (CONTINUED) 
HIGH-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


procedure construct-high-int-hca-bdry /* constructs each type of bdry formed by*/ 
input: type of bdry T; P, the start-point of bdry; /* a high-cost, interior-goal HCA. */ 
output: Bdry, the resulting boundary; 
purpose: to construct a boundary generated from point P of type T; 
(if T = "hidden-edge" Bdry := curve as specified in Lemma V-5.1; 
if T = "hidden-edge/goal" Bdry := curve as specified in Lemma V-5.2; 
if T = "visible-edge/goal" Bdry := curve as specified in Lemma V-5.3; 
if T z "interior-opposite-edge" Bdry :- curve as specified in Lemma V-5.4; 
if T 2 "bca-edge" Bdry :- curve as specified in Lemma V-5.5; 
if T = "shadow" Bdry := curve as specified in Lemma V-5.6; 
if T 2 "exterior-opposite-edge" Bdry :- curve as specified in Lemma V-5.7; 
if T = "corner-cutting" Bdry :—- curve as specified in Lemma V-5.8; 
if T = "visible-edge" Bdry := curve as specified in Lemma V-5.9; 
} /* end of construct-high-int-hca-bdry */ 


procedure post-process-high-int-hca-bdrys /* store bdrys and edges. */ 
input: VisEdgeSet, the set of bdrys from visible edges, IntBdrySet, the set of 
interior bdrys, ExtBdrySet, the set of exterior bdrys, and Optimal-Path Tree N; 
output: DCEL M, and revised OPT N; 
(for each edge E e VisEdgeSet 
{for all Maske E := E less Maskg; 
N := value retumed by insert-into-opt(N,E); 
| 
for each bdry B € IntBdrySet 
if another version of B exists 
{truncate B and B"; 
insert-into-dcel(M,Btrunc); 
) 
for each bdry B € ExtBdrySet 
join-high-int-bdrys(B,ExtBdrySet); 
for each bdry B e ExtBdrySet 
insert-into-dcel( M,B); 
) /* end of post-process-high-int-hca-bdrys */ 


procedure join-high-int-bdrys /* joins external bdrys. */ 
input: bdry B y, set of bdrys ExtBdrySet; 
output: revised ExtBdrySet; 
purpose: to pair bdrys which first intersect, and propagate new ones from their pt of intersection. 
(for each B2 € ExtBdrySet such that B; and B2 intersect and Bl and B2 are adjacent 
{truncate By and B2; 
remove original B | and B2 from ExtBdrySet; 
add B1"""" and B2"""" to ExtBdrySet; 


T := type of new bdry; /* based on edges El and E2 not */ 
B3 := value returned by /* common to B,""** and B2™", */ 
construct-hca-opm-high-int-bdry(T,E,,E2) 
join-high-int-bdrys(B3,ExtBdrySet); /* recursively follow bdry outward from HCA. */ 
| 

) /* end of join-high-int-bdrys. */ 
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6. An Algorithm for OPM Construction for A Single Low-Cost, Exterior-Goal 
Homogeneous-Cost Area 

The exterior-goal-low-cost-region algorithm shown in Table 11 looks at each HCA vertex in turn, 
basing its logic on the initial direction of the optimal path from the vertex being examined (see Figure 27). If 
the optimal path from a vertex goes into the HCA interior, two rays, or vertex/edge-crossing boundaries, are 
constructed forming a wedge outward from the vertex and away from the goal. If the optimal path goes along 
an edge of the HCA, one of the above boundaries, the one closer to the direction of travel of the optimal path, 
is instead a vertex/edge-following boundary, and in addition a parabolic, or vertex/goal boundary is con- 
structed. The third possibility is that the optimal path goes directly into the HCA exterior, i.e., toward the goal. 
If so, more boundaries may or may not be generated. If a portion of each edge adjacent to the vertex is visible 
to the goal, i.e., if for both edges there are paths starting at some points on the edges which go directly into the 
HCA exterior, then a visible-edge boundary will emanate from the vertex into the HCA interior. 

With the above boundaries generated, two tasks remain. First, each parabolic, or edge-following/goal 
boundary must be followed away from the goal to see if it intersects the next ray boundary. If so, ahyperbolic, 
or vertex/goal boundary will begin, with one focus at the vertex. This hyperbola must then be followed in tum. 
If it intersects a ray boundary, a "distorted-parabolic", or edge-crossing/goal boundary will begin. As we con- 
tinue to follow this sequence of boundaries, hyperbolas and distorted-parabolas occur alternately until i" in- 
tersection with a ray is found. Note that this algorithm generates each parabolic and distorted-parabolic 
boundary in the initial phase, and then generates hyperbolas as needed in procedure add-hyp-bdrys-for-low- 
ext-hca below, which in addition truncates each boundary as necessary. 

Although this type of HCA has interior boundaries, which one might suppose would need to be paired 
and merged as with the high-cost, exterior-goal case, in fact it is not necessary to do this. The reason is that 
such boundaries are all of the visible-edge type, and because the HCA interior is of lower cost than the sur- 
rounding terrain, these boundaries will never intersect. Intuitively in the high-cost exterior-goal case, a path 
travels to an edge further away in straight-line distance in order to take advantage of the lower external cost 
outside that edge, and at that point, two boundaries would intersect and a third emerge. Here, however, the 
path is already in the least costly terrain possible, and so further paths will continue to follow the same paths 


as those closer to the goal. For each visible-edge boundary, a point of intersection is plotted with the far edge 
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TABLE 11 


LOW-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


algorithm hca-opm-low-ext 


input: Optimal-Path Tree with root N, and HCA A; 
output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: construct an OPM for a low-cost, exterior-goal HCA; 


(algorithm VI-6) 


for each vertex V of A with incident edges Ej and E? /* consider each vertex and its adjacent edges */ 
such that E; 2 VV; and E2 2 VV2, where IV2Gl 2. /* where V1 is closer to goal than V2, and */ 


IV1Gl and OPL(V) 2 [P | OPL(P)] 
{ 
if VP lies in HCA interior 
{ 
construct-low-ext-hca-bdry(vertex/ 
edge-crossing, V,V i, V2); 
construct-low-ext-hca-bdry(vertex/ 
edge-crossing,V,V2,V 1); 
insert-into-opt(N, VV 1 Far-side); 
insert-into-opt(N, VV2,Far-side); 
| 
else if VP lies along HCA edge Ej 


| 


construct-low-ext-hca-bdry(edge-following/ 


goal, V, V1, V2); 
construct-low-ext-hca-bdry(vertex/ 
edge-following, V,V1,V2); 
construct-low-ext-hca-bdry(vertex/ 
edge-crossing, V, V2, V1); 
insert-into-opt(N, VP,Near-side); 
insert-into-opt(N,VV2 Far-side); 
) 


/* where P is the first point on V’s opt path. */ 


/* if optimal path from V goes into HCA interior */ 


/* two rays are Snell’s-Law paths across */ 
/* edges E; and E2 through vertex V */ 


/* add edges to OPT as region roots. */ 


/* if opt. path from V goes along an HCA edge */ 


/* two rays are Snell’s-Law paths across */ 
/* edges Ej and E2 through vertex V */ 


/* add edges to OPT as region roots. */ 


else if ((Q1 is in HCA exterior) or (ViQie ViV)) /* if both edges are visible or partially visible */ 
and ((Q2 is in HCA exterior) or (V2Q2€ V2V))) /* (optimal path from V lies in HCA exterior). */ 


where OPL(V 1) = [Q1 | OPL(Q))) 
and OPL(V2) = [Q2 1 OPL(Q2)) 
( 
construct-low-ext-hca-bdry(visible-edge, 
V,V1,V2); 
fori:=1to2 
if(ViQie ViV) 
insert-into-opt(N, Q1V, Far-side); 
else insert-into-opt(N, V¡V, Far-side); 
) 
) 
add-hyp-bdrys-for-1ow-ext-hca(ParabBdrys); 
| 


128 


/* Note: Qi are tbe first points on */ 
/* the optimal-path lists of each Vi */ 


/* vis-edge bdry from V w.r.t. E1 and E2 */ 
/* add as region root the portion of */ 


/* edge across which paths cross. */ 


/* end of algorithm hca-opm-low-ext */ 


TABLE 11 (CONTINUED) 
LOW-COST EXTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


procedure add-hyp-bdrys-for-low-ext-hca; /* puts hyperbolas between pairs of ray bdrys */ 
input: ParabBdrys, the set of parabolic boundaries; 
output: revised DCEL; 
purpose: to concatenate hyperbolic bdrys onto parabolic ones. 
| 
while ParabBdrys # © 
{ 
select bdry B¡€ ParabBdrys associated with vertex Vj and edge Ej; 
truncate B | and the vertex/edge-following or vertex/edge-crossing bdry B2 emanating 
from Vi, and associated with edge E; at the point where they intersect; 
B4 :- value returned by construct-low- /* bdry is hyperbola intersecting one or */ 
ext-hca-bdry(vertex/goal, Vi, Vj, Vk); /* both rays emanating from vertex Vj; */ 
if Bg intersects vertex/edge-crossing bdry 
B3 associated with V; and edge Ex, kzj, 
| 


truncate B3 and B4 at their point of intersection; 
truncate B5e ParabBdrys assoc. with Vg and Ex, gAi, at its intersection with B3 and B4 ; 


) 
remove Bı from ParabBdrys; 
) /* end add-hyp-bdrys-for-low-ext-hca */ 


of the HCA, and an opposite-edge boundary is generated, which is really just a continuation of the ble: 
edge boundary after crossing another edge. 

Procedure construct-low-ext-hca-bdry performs the low-level function of generating each bound- 
ary for the low-cost, exterior-goal HCA as needed. For boundaries whose forms are general curves, the reader 
is referred to the appropriate Lemma in Chapter V and proof in Appendix A. 

7. An Algorithm for OPM Construction for A Single Low-Cost, Interior-Goal 
Homogeneous-Cost Area 

Algorithm hca-opm-low-int is the simplest of the four HCA algorithms, in keeping with the simple 
nature of the regions and boundaries associated with this type of HCA (see Figure 28 and Table 12). Since a 
low-cost, interior-goal HCA generates only one wedge of two rays at each vertex, and these rays are guaran- 
teed by the orientation of the HCA edges not to interact, the corresponding algorithm can do its work in one 


pass through the list of vertices. 
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TABLE 12 
LOW-COST INTERIOR-GOAL HCA OPM CONSTRUCTION ALGORITHM 


algorithm hca-opm-low-int (algorithm VI-7) 
input: Optimal-Path Tree with root N, and HCA A; 
output: Optimal-Path Map M (a DCEL) and modified Optimal-Path Tree N; 
purpose: to construct the OPM for a low-cost,, interior-goal HCA; 
| 


M := empty dcel structure; 


for each edge V¡V2 of A 
| 
Bdry| := ray starting at V1, lying away /* two bdrys emanate from each vertex, */ 
from Goal G thru pt X1, such that /* at the Snell's-Law angle with respect */ 


ZGV1V2= 2-01, ZXIV1V2 2 724-05 , /* to each edge. */ 
and cint sin®1 = cext sin 82; 
Bdry2 := ray starting at V2, lying away 
from Goal G thru pt X2, such that 
ZGV2w = 10/28 1, ZX2V2V) = 1/2402, 
and cint sinO; 2 cexcsin 02; 


insert-into-dcel( M,Bdry |); /* add vertex/edge-crossing bdrys to DCEL. */ 
insert-into-dcel(M,Bdry?); 
insert-into-dcel(M, V1 V2); /* add HCA-edge boundary to DCEL */ 
insert-into-opt(N,edge V1V2,Far-side); /* add edge which is crossed to OPT. */ 
| 

) /* end of hca-opm-low-int */ 


C. EXTENDING THE BASIC ALGORITHMS TO MULTIPLE CONNECTED RIVER AND 
ROAD SEGMENTS 
1. An Algorithm for OPM Construction for Multiple Connected River Segments 

It is now possible to build on a basic understanding of the nature of boundaries generated by single, 
isolated river segments in order to construct the boundaries associated with multiple, connected linear river 
segments, or rivers. There may be two or more river segments emanating from a single vertex, but all seg- 
ments of a river must have the same crossing cost. It might be thought that the algorithm proposed below to 
construct the optimal-path map for multiple terrain features could be used to construct it for this kind of ter- 
rain as well. However, connected river segments are not "decomposable" into their constituent segments. 


Decomposability of a set of terrain features is defined as follows. 
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Terrain map M with optimal-path tree N is defined as decomposable for path planning into subsets 
S1 and S2 if both S; and S2 are consistent with OPT N. Say that a set of terrain Sj which is a subset 
of a set of terrain S is consistent with an OPT N constructed for S if for an OPT Nj constructed for 
Si considered alone, every node of Ni appears in N, and the parent of every node of Ni appears in 
the path from the node to the root of N. 


In other words, if one subset could not behave in the way it does without the presence of the other, 
the terrain is not decomposable. Connected river segments have as part of their nature that at internal vertices, 
i.e., where two segments join, there are regions where paths must either cross a river or move away from the 
vertex, while for the individual segments, a path could bypass the river segment by simply moving around the 
vertex. Thus a set of connected river segments is not decomposable into its individual segments. 

Two high-level paradigms in addition to those used for single river segments are useful here. First, 
we partially sort the river segments according to their general visibility to the goal, i.e., so that a segment which 
is fully or partially occluded by another follows it in the partial order, and we process the segments according 
to this partial order. Thus boundaries which may affect other segments are already in place by the time the 
other segments are considered. Second, whenever a boundary intersects an occluded segment, an event point 
is generated. When a segment is processed, itis necessary to consider each event point and decide whether the 
boundary which caused the event point continues on the other side of the river segment. Figure 33 shows a 
river consisting of connected river segments, and Figure 34 shows a worst-case orientation of segments. - 

Several new terms must be defined. General visibility between two terrain features is defined as fol- 
lows. Two features F1 and Fp are generally visible with respect to a goal G if there is a sequence of features 
Fi, 1=1 to n, such that for all i, Fi is visible to Fi+1. A feature F; is occluded by another Fj with respect to goal 
G if for every sequence by which F; and G are generally visible, F; is a member of the sequence. In other words, 
Fi is occluded by Fj if it is partially or completely within the shadow of Fj cast by G. An endpoint V of line 
segment L; is defined as an exterior vertex if V is not an endpoint of any other line segment, or if segment L2 
of which V is an endpoint occludes L1. V is defined as an interior vertex if it is not an exterior vertex. Intui- 
tively this means that an optimal path from an interior vertex must either cross the river or move away from 
the vertex to get past the line segment, while from an exterior vertex an optimal path can simply move around 
the vertex and bypass the river. Figure 33 shows the partial ordering of river segments as well as the exterior 


or interior nature of each vertex. 


131 


$ Goal D a Lt 


1 
\ River Segment (i,j) 
j 


A Boundary 


.74 Extension of Bdry 
for Illustration 


Ll Event Point 
X  Bdry Intersection 





PARTIALLY-ORDERED 


































EXAMPLES: RIVER SEGMENTS 
EXTERIOR OR INTERIOR 
VERTEX? GOAL 
Vtx W.R.T. Segment Type 
1 (1,2) Exterior 
2 (1,2) Exterior (4,3) (3,2) 
2 (2,3) Interior 
3 (2,3) Interior 
3 (3,4) Interior (4,5) (12) 
4 (3, 4) Interior sina 3 
4 ( an 5) —— 
, xterior 
5 (4,5) Exterior AR 
5 (5,6) Exterior 
(5,6) Interior 


(6,7) Interior 







(8,9) (9,10) (10,11) 





Figure 33 
Multiple Connected River Segments 


132 






















KEY: 
Goal 


tooo 
q... 
.... 


River Segment 


Boundary 


Extension of Bdry 
for Illustration 


Event Point 


Start of New Bdry 


ili Jura | 


/ 


Shadow Bpundaries Shadow Mpundaries 


d 


Y 


i i : iver-Crossin indart 
River-Crossifg Boundaries River-Crossing B\}indartes 


Figure 34 


Worst-Case Complexity of Multiple Connected River Segments 


133 


The algorithm based on these ideas is complicated by the possibility that rivers may turn back on 
themselves and create pockets where, for a high-enough crossing cost, it is cost-effective to move away from 
the goal out of the pockets rather than cross a river. This situation is illustrated in Figure 33a, in the vicinity 
of vertices 8 through 11. À type of boundary in addition to those presented in Chapter V for single river seg- 
ments is generated in this case, although it is very similar to the other types. Whenever an exterior vertex V1 
is encountered in the course of processing river segments, a river-crossing boundary is generated for that ver- 
tex, as explained in Chapter V. If this boundary does not intersect any segment between V1 and V2, all paths 
from immediately on the far side of the river including the path from V2 will go via V1. In this situation there 
will be a boundary which separates paths which cross a river toward the goal from those which move away 
from the goal and eventually go through V2 and then through V ¡. At each interior vertex, as well as at the next 
exterior vertex, a portion of this boundary will be generated. This type of boundary 1s called a near-side-river- 
crossing boundary and it is exactly the complement of the river-crossing boundary which would be generated 
from that vertex if an optimal path from the vertex lay forward across the river. In other words, it starts at the 
current river segment and lies forward toward the goal. 

An example of a near-side-river-crossing boundary in Figure 33 has one end-point on segment (8,9). 
From there, it lies toward the goal until it intersects a shadow boundary which starts at vertex 9. The next por- 
tion of the boundary is the hyperbola segment whose axis is the line between vertices 10 and 4. After it inter- 
sects the shadow boundary from vertex 10, the boundary is the hyperbola segment whose axis is the line 
between vertices 11 and 4. Finally, it ends at the point where it intersects a river-crossing boundary separat- 
ing points whose paths go around vertex 5 from those whose paths cross segment (7,8). From there an op- 
posite-edge boundary begins, separating points whose paths go around vertex 5 from those which go around 
vertex 11. À second example of a near-side-river- crossing boundary is in the vicinity of vertex 1. 

At each interior vertex V, the test for a near-side-river-crossing boundary is as follows. If for a point 
arbitrarily close to V, but on the near side of the river, called V , the optimal-path list of V includes Vext, the 
currently active exterior vertex, a near-side-river-crossing boundary is generated. The foci are V and the ver- 
tex or goal point X such that the cost of a straight-line path from V to X plus the cost of the optimal path from 
X is minimized, and the hyperbolic constant is the cost of the optimal path from V minus the sum of the cost 


of the rivers crossed from V to X and the cost of the optimal path from X. In this case, the shadow boundary 
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from V may intersect the boundary at a point P. The boundary starts at its intersection with the current river 
segment, or if it is the second or subsequent portion of the boundary to be generated, at its intersection with 
the previous boundary portion, and ends at point P. If the boundary intersects the nver-crossing boundary 
generated by Vext, it ends at that point and the Vex: boundary constitutes the remainder of the boundary. 

Shadow boundaries follow the same specifications as listed in Chapter V, namely that a vertex V, 
with an optimal path which goes first to point P, generates a shadow boundary which is a ray starting at V and 
lying away from P on the line VP, but with the variation that it must be considered whether the optimal path 
of V crosses the river segment or not. If for V. as defined above, and for V* arbitrarily close to V on the far 
side of the river segment, V. can be positioned so as to lie on the optimal path of V*, a normal shadow bound- 
ary results. This is the case where paths from the far side of the river may cross in the vicinity of V, and such 
a boundary simply keeps track of which segment the paths cross. 

If V includes in its optimal path the current Vext, it will be the case that V~ does so as well, and the 
shadow boundary which results will conform to the above specification with respect to V and will have the 
unusual characteristic that it lies on the near side of the river segment. This is the case where points on the near 
side of V are caught in a "pocket" for which it is faster to move away from the goal and around Vex than to 
cross river segments forward of V. Such a shadow boundary separates points which go to V and then to the 
vertex on the next river segment from those which bypass V and go to the next vertex directly. 

If V* includes in its optimal path the current Vext, but V does not, the shadow boundary from V will 
be formed with respect to V*, and lie on the far side of the river. This is the case where the optimal path of V 
lies on the same side of the river segment as does the optimal path of Vext, but the optimal path of V* includes 
Vext, Signifying that paths on the far side of the river in the vicinity of V will not cross it, but paths on the near 
side will lie generally toward the goal, not being caught in a "pocket" which causes them to move away from 
the goal to avoid crossing subsequent river segments. Table 13 shows the algorithm for construction of mul- 


tiple connected river segments. 
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TABLE 13 
MULTIPLE-CONNECTED-RIVER-SEGMENT OPM CONSTRUCTION 
ALGORITHM 


algorithm multi-segment-river-opm (algorithm VI-8) 
input: List of river segments R, river-crossing cost Cr, Optimal-Path Tree N, Goal G; 
output: DCEL M and revised OPT N; 
purpose: construct a planar partition and revise the OPT for multiple, connected river segments; 
{partially order R so that Si < Sj iff Sj obscures part of Sj with respect to G; 
for each segment S € R in partial order, letting S = V1V2 where V1 is closer to G than is V2 
{plot shadow bdry from V1; 
plot shadow bdry from V2; 
intersect bdrys with all subsequent segments, noting an event-point whenever intersection occurs; 
if V1 is "exterior" 
{ Vext := Vti 
sort event-pts on V1V2 with respect to Vi, 
including V2 as an event-point; 
until a river-crossing bdry is plotted for V 1 
or event-list is empty 
(select next event-point E; 
Er := root of region on side of E closer to V1; 
Cvext:z IEVexd t ( VexiG)"l; 
Cer := IEEd + (E G)" 
if Cvext > CEr 
plot river-crossing bdry with respect to Vext and Es; 
else 
delete portion of bdry Bg lying away from Goal; 
| 
| 
else 
do nothing; [* if Vi is "interior". */ 
if V2 is "interior" 
(V2 :- point arbitrarily close to V2 on same side of river 
as first leg of optimal path from Vex; 
V2* := point arbitrarily close to V2 on opposite side of river 
as first leg of optimal path from Vext; 
if Vex € (V2G)* and Vex € (V2*G)* 
(plot shadow bdry B1 such that for OPL(V2 G)* z [P ! OPL(P)], 
B¡ := ray on line V2P starting at V2, lying away from P; 


X := vertex or goal such that /* ie, vertex with best cost from V2 to X to Goal, */ 
IVa2XI -- (XG)*! is minimized; /* with hyp cost := C;-no. rivers crossed by V2X. */ 
plot B2 := near-side-crossing bdry with /* note that if intersection is beyond V 1, there is */ 


foci V2 and X, where B2 starts at point of /* another near-side-crossing bdry which */ 
intersection with line V1V2 and ends at /* intersects B2. */ 
intersection with B; 


| 

else if P^ « P*, where OPL(V2) 2 [P | OPL(P)] and OPL(V 15 = [P* 1 OPL(P5)] 
plot shadow bdry on line V2P* starting at V2 lying away from P"; 

) 
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TABLE 13 (CONTINUED) 
MULTIPLE-CONNECTED-RIVER-SEGMENT OPM CONSTRUCTION 


ALGORITHM 
else /* V2is “exterior”. */ 
if Vet € (Vi G)* and Ve« € (Vi*G)* /* if V2 is "hidden". */ 


(plot shadow bdry B, such that for OPL(V | G)* = [P | OPL(P)], 
B¡ := ray on line V¡P starting at V1, lying away from P; 


X := vertex or goal such that /* ie, vertex with best cost from V1 to X to Goal, */ 
IV XI + (X G)*l is minimized; /* with hyp cost :z Cr: no. rivers crossed by V2X. */ 
plot B2 := near-side-crossing bdry with /* note that if intersection is beyond V2, there is */ 


foci V1 and X, where B2 starts at point of /* another near-side-crossing bdry which */ 
intersection with line V;V2 and ends at /* will intersect B2. */ 
intersection with B 1; 

| 

else /* V2is "visible". */ 

( Vext := V2; 

sort event-pts on V1 V2 with respect to V2, 
including V1 as an event-point; 

until a river-crossing bdry is plotted for V2 
or event-list is empty 
{select next event-point E; 
Er := root of region on side of E closer to V2; 
Cvext :z IEVexd + I(VextG)* 1; 
Cer := IEEd + 1(E,G)*1; 
if Cvext > CEr 

plot river-crossing bdry with respect to Vex: and Ex; 
else 
delete portion of bdry Bg lying away from Goal; 
| 
join and merge bdrys associated with V V2, noting all 
intersections with obscured segments as event-points. 
) /* end of "for each segment". */ 
join and merge all bdrys; 
} /* end of algorithm multi-segment-river-opm. */ 


2. OPM Construction of Multiple Connected Road Segments 

Unlike connected river segments, connected road segments are decomposable into their constituent seg- 
ments. The basic reason for this is that road segments will not serve to block or hinder paths, but only to operate 
as conduits. Therefore, connected road segments can be decomposed into individual segments by algorithm 


VI-9 below, algorithm VI-3 used on each segment, and the resulting OPM’s merged into a final OPM. 
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D. A DIVIDE-AND-CONQUER ALGORITHM FOR MULTIPLE-FEATURE OPM 
CONSTRUCTION 

A principal goal of our research is to find an algorithm which will create optimal-path maps for multiple 
terrain features of the four types described above. Although the investigation into this problem is not complete 
in all its details, we propose the following high-level description of such an algorithm (see Table 14). 

Methods for constructing Voronoi diagrams (see Chapter II) provide a model for approaches to the con- 
struction of an optimal-path map for multiple terrain features. Voronoi diagram methods use a divide-and-con- 
quer approach, in which the points in the plane are divided into two roughly equal sets, the Voronoi diagrams 
of the two sets computed recursively, and the two Voronoi diagrams merged to produce the final one. The first 
key question is how to divide the points in the plane. The answer in this case is that in order to support the 
merge phase, the plane is partitioned into two half-planes by a line (by convention, a vertical line) which equal- 
ly divides the set of points in the plane. The other key question is whether the two intermediate Voronoi 
diagrams can be merged. Standard generalized- Voronoi-diagram construction algorithms provide an affirm- 
ative answer to this question, depending on the fact that the boundary between any two Voronoi regions in bi- 
nary terrain (i.e., obstacles on a homogeneous-cost background) is a straight line segment or a hyperbola 
segment [Ref. 8]. 

The analogous questions with respect to optimal-path map construction are whether terrain features can 
be divided in the same manner as points, and how two optimal-path maps with the same goal can be merged 
into a single, combined OPM. An encouraging aspect of this problem is that when constructing OPM's for 
single terrain features, we rely on the optimal paths from only the terrain-feature vertices, which are computed 
by standard point-to-point path planners and take all the features of a map into account. Thus the optimal paths 
from any vertex will remain the same regardless of which terrain features are incorporated into the OPM. 
Another important aspect of this problem is the unifying perspective with regard to regions and boundaries 
proposed in Chapter V, Section C. Since there are only three types of non-degenerate region roots, i.e., points, 
edges traversed length-wise, and edges traversed cross-wise (according to Snell's Law), it should be possible 
at the intersection of any two general boundaries to generate a new boundary by considering the six types of 
boundaries between regions of three possible types of roots. Actually, as discussed in Chapter V, the Snell ’s- 


Law edges do not comprise a single class of region roots, because edges with different numbers of edge-cross- 
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TABLE 14 
MULTIPLE-FEATURE OPM CONSTRUCTION ALGORITHM 


algorithm multiple-feature-opm (algorithm VI-9) 
input: L a listing of lists of vertices and types of each terrain feature, and 
N, the optimal-path tree associated with Map; 
output: M, a DCEL describing the planar partition of OPM associated with Map, revised OPT N; 
purpose: to construct an optimal-path map for input map consisting of any number of terrain features; 


| 


if Map contains only one terrain feature /* base case of the recursion. */ 
OPM := appropriate single-feature algorithm; 
else 
| 
(Seti,Set2) :z value returned by halve-map; /* divide map into two roughly equal sub-maps. */ 


N 1 := N less region roots associated with Set; 

N2 := N less region roots associated with Sety; 

OPM] := value retumed by multiple-feature-opm(Seti, N1);/* recursively solve each sub-problem. */ 
OPM? := value retumed by multiple-feature-opm(Set2, N 1); 

OPM := result of merge-opms(OPM1,0PM2,N 1,N2) /* find OPM by merging two sub-OPM’s. */ 
} 


} /* end of multiple-feature-opm. */ 


procedure halve-map 
input: Map, the list of lists of terrain-feature vertices and types; 
output: a pair of sets such that the first is the left half of the map and the second is the right half: 
purpose: divide Map into two roughly equal-sized sub-maps; 


for each decomposable terrain feature 
find the left-most vertex; 
compute the median x-coordinate; 
for each terrain feature F 
if its left-most vertex is less than the median 
Seti :- Seti Ul F); 
else 
Set2 := Se2U {F}; 
} /* end of halve-map. */ 
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TABLE 14 (CONTINUED) 
MULTIPLE-FEATURE OPM CONSTRUCTION ALGORITHM 


procedure merge-opms 
input: OPM; and OPM2, DCEL’s of the two input OPM’s; 
output: OPM, the DCEL containing the planar partition of the merged map; 
OPT N, the revised optimal-path tree; 
purpose: merge two OPM's into one; 
{O := vertical chain such that all terrain features of OPM) are entirely 
to its left and all terrain features of OPM are to its right; 
BdrySet := Set of all B such that Be OPM) or BE OPM? and B intersects O; 
while BdrySet is changing 
{ PairedBdrySet := BdrySet; 
while PairedBdrySet is changing 
(for all B¡¡€ PairedBdrySet /* where h, 1, j, and k index the regions of OPM. */ 
where Bj ¡ is unmarked 
(discard Bi,j from PairedBdrySet; 
add Bi; from BdrySet to PairedBdrySet; 
intersect Bj, j with Bp ; and truncate both; 
add Bn ^ "* and Bi, ^"^ to PairedBdrySet; 
intersect Bij with Bs andtruncate both; 
add Bi, {rune and Bik jk :z to PairedBdrySet; 
| 
for all B¡ ¡€ PairedBdrySet 
discard all but the shortest Bi j from PairedBdrySet; 
unmark all bdrys in PairedBdrySet; 
for all Bij and Bj ke PairedBdrySet such that Bij adjoins th 
mark Bi; T and B jk 


} 

for all B¡ ¡and B¡x€ PairedBdrySet such that Bi,¡ adjoins Bj,k 
add Bik to PairedBdry Set, 

BdrySet := PairedBdrySet; 

} 

for each new B’ € BdrySet 
(intersect-and-merge(B , (all bdrys from OPMi assoc with R1)); 
intersect-and-merge(B”, (all bdrys from OPM2 assoc with R2)); 
| 


} /* end of merge-opms. */ 


procedure intersect-and-merge 
input: B, a new boundary, and BdrySet, a set bdrys potentially intersecting B; 
output: revised DCEL M; 
purpose: propagate the effects of new boundary B in one of the subordinate OPM's; 
(for each bdry B' € BdrySet 
if B intersects B’ 
{truncate B and B’at their point of intersection; 
find regions Rj and Rj which are adjacent to B and B ‘respectively, but not common to both; 
construct Bnew by referring to the roots of Ri and Rj respectively; 
for each boundary Bin BdrySet which B ‘previously intersected 
intersect-and-merge(B , BdrySet less B’); 


| 
} /* end of intersect-and-merge. */ 
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ing episodes enroute to the goal will create boundaries of different analytic characteristics. However, the con- 
cept is promising. 

To divide decomposable terrain features (see Section C above fora definition of decomposability) of the 
input map into two approximately equal sets whose resulting OPM’s can be merged is not difficult. In fact, it 
appears that any partition is feasible as long as it does not split a terrain feature, but some will be much more 
efficient than others. Of course the advantage of a divide-and-conquer algorithm is its loganthmic performance 
in the recursive stage if it is guaranteed that divisions are approximately equal-sized, so any partitioning pro- 
cedure should have this property. Also, it should not take an excessive amount of time to accomplish the par- 
tition, since this step will play an important part in the overall time complexity. And thirdly, since the merging 
step will depend on checking for intersections between all boundaries of one sub-OPM and all boundaries of 
the other, it would be very useful if it were not necessary actually to check most of these boundaries. This 
would be the case if at each step in the recursion, the two OPM’s represented terrain which did not, loosely 
speaking, "interleave". For such OPM’s, boundaries which lay wholly within the interior of the two planar 
partitions would not have to be checked for intersection. 

The merge step depends on the fact that any two boundaries, when they intersect, represent the meeting 
point of three regions, one of which is common to both boundaries. A new boundary will emanate from the 
point of intersection which separates the two regions which the original boundaries did not have in common. 
Rather than attempt to study all the special cases of possible region intersections among boundaries present in 
the nine algorithms thus far presented, it is preferable to use the unifying approach to boundary generation 
which considers the two types of region roots involved and selects from the limited number of boundary types 
to find the new boundary. However, since there are infinitely many possible types of Snell’s-Law edges based 
on the number of edge-crossings between the edge and the goal, an approximate solution is proposed. Since 
boundaries between Snell's-Law edges are similar to hyperbolas, it is proposed that for all except the varieties 
already derived in Appendix A, hyperbolas be used as approximations to the exact curves. 

When a new boundary has been generated because of the intersection of two boundaries from different 
sets, the effects may propagate into both partial OPM's. This will be, in the worst case, a very expensive opera- 
tion, because unlike Voronoi diagram construction, the boundaries between regions are not simple lines, and 


the effects are not guaranteed to be local. Each boundary which is truncated by the new boundary must be fol- 
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lowed to its end (before it was truncated), and if it intersected other boundaries, these in tum must be recon- 
sidered with respect to the new boundary. 

Algorithm VI-9 describes this method of constructing an optimal-path map for input maps containing 
any number of the seven types of primitive terrain features and connected river and road segments. At each 
level of recursion, the algorithm divides the terrain into two roughly equal sets, based on a calculation of the 
median leftmost vertex. At the lowest level, that of a single terrain feature, the algorithm calls on Algorithms 
VI-1 through VI-8 to construct an OPM for the feature. At higher levels, OPM’s are merged by procedure 


merge-opms. 
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VII. ANALYSIS OF DIVIDE-AND-CONQUER EXACT-OPM ALGORITHM 


A. SOURCES OF ERROR IN THE ALGORITHM 

The divide-and-conquer exact-OPM algorithm produces a more accurate optimal-path map than the 
wavefront-propagation OPM algorithm, but it still has error with respect to the conceptual OPM it models. In 
terms of the categories of error discussed in Chapter II, the model-cost versus real-world-cost error occurs be- 
cause of approximations in the terrain database of continuously-varying terrain with 12.5m square cells. 

The second category of error, model-computed-cost versus model-optimal-cost, appears in several forms 
in the output of this algorithm. The two most significant are discussed here. First, each boundary whose anal yti- 
cal form does not have a closed-form solution is represented by a piecewise-linear approximation. These boun- 
daries are plotted parametrically, iteratively setting one parameter and solving for the other. Fortunately for 
the precision of the algorithm, most boundaries have very little curvature (see for example, Figures 22, 23, and 
24). Anexact analysis of the impact of this type of error has not been done, but the proof-of-concept implemen- 
tation for the high-cost, exterior-goal homogeneous-cost area (HCA) plotted twenty or fewer points for each 
curve, and in all test cases, error of this type was too small to be visible in the laser-printer output. 

What error does occur will have the effect of causing start points which are close to a boundary to be 
placed in an incorrect region. These start points will then be associated with paths which are not quite optimal. 
But along a boundary there are two equal-cost paths to the goal from each start point. On an approximate 
boundary one of these two paths will be slightly more costly than the other. This error will be no greater than 
the cost-rate in the region times the maximum distance of the piecewise-linear approximation from the actual 
curve. Since the approximations seem to be very close to the actual curve in observed cases, it seems safe to 
state that this error can be ignored in most practical applications. 

A second source of error in the category of model-computed-cost versus model-optimal-cost is using hy- 
perbolas to approximate boundaries between homogeneous-behavior regions having paths with more than two 
Snell’s-Law crossings. An exact analysis of the error — here has not been done. But for regions whose 
paths have multiple Snell's-Law crossings leading to a region root which is a point, as the regions lie further 


and further away from the point, they have cost functions (called "distorted cones") which have flatter and 
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flatter iso-cost contours, leading to boundaries with less and less curvature. The approximating hyperbola 
should be closer and closer to the actual boundary as the boundary becomes almost linear. The error in the 
computed cost of an optimal path caused by this approximation can be ignored in most applications. 

The third category of error discussed in Chapter II, that of model-computed-location versus model-op- 
timal-location, occurs only in the situations discussed above where a start point is incorrectly placed on the 
wrong side of a boundary. When this happens, the computed path will have a distinctly different behavior than 


the true optimal path. 


B. TIME AND SPACE COMPLEXITY OF THE ALGORITHM 
We begin by analyzing the construction of the optimal-path tree, and then analyze the algorithms proposed 
for each primitive terrain feature type in an isolated setting, because the final algorithm uses the previous ones 
as base cases of its recursion. 
1. Time and Space Complexity of Optimal-Path Tree Construction 
Prior to the execution of the algorithms introduced in Chapter VI, the optimal-path tree (OPT) must 
be constructed. A brute-force method which finds optimal paths from each terrain-feature vertex and then in- 
serts each path into the OPT would take, using the continuous-Dijkstra algorithm, O(n*L) time in the worst 
case, and using recursive wedge decomposition, O(n)) in the average case, where n is the number of terrain- 
feature vertices, and L is a measure of the precision of the problem representation. Insertion into the OPT as 
described in Chapter VI would take, in the worst case, no more than O(n’) time, because no path list is longer 
than n, and there are n path lists to be inserted. The optimal-path tree has no more than one node for each ter- 
rain-feature vertex and edge, plus one for the goal point. Thus, its worst-case space complexity is O(n), since 
with the assumed terrain constraints, there are O(n) edges. À more efficient way to use the continuous-Dijkstra 
algorithm is possible which computes paths to all vertices and builds the OPT in one execution of the algo- 
rithm, giving O(n’L) worst-case time complexity. Recursive wedge decomposition can also be modified to 
operate this way. 
2. Time and Space Complexity of The Single-Obstacle-OPM Algorithm 
Algorithm VI-1 constructs an optimal-path map for a single isolated convex obstacle with respect to 


a goal. For an obstacle with n vertices there are at most n shadow boundaries, which can be constructed in 
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O(n) time by a depth-first traversal of the the optimal-path tree, generating a shadow boundary for each node 
in the tree except the one representing the empty path list. Each hyperbola segment which is part of the op- 
posite edge can be constructed in constant time, and there are at most n-2 intersections of the opposite-edge 
boundary with shadow boundaries. Thus the opposite-edge boundary can be constructed in O(n) time, so the 
entire OPM can be constructed in O(n) time. Each shadow boundary and each hyperbola segment of the op- 
posite-edge boundary can be represented in O(constant) space. Since the optimal-path tree can be stored in 
O(n) space, and assuming constant accuracy, the representation of the entire OPM 1s O(n) space. (See Figure 
17.) 
3. Time and Space Complexity of The Single-River-Segment-OPM Algorithm 
Algorithm VI-2 constructs boundaries generated by a single nver segment. A river segment has ex- 
actly two shadow boundaries, at most two river-crossing boundaries, and exactly one river-obstacle boundary 
consisting of only one — segment. Thus there at most five boundaries to construct, each of which can 
be constructed in O(constant) time, so the time complexity of the algorithm is O(constant). Similarly, the space 
complexity is O(constant). (See Figure 18.) 
4. Time and Space Complexity of The Single-Road-Segment-OPM Algorithm 
Algorithm VI-3 constructs boundaries generated by a single road segment. By the analysis of Chap- 
ter V, a road segment may have at most fourteen boundaries, each of which can be constructed in O(constant) 
time, using O(constant) space. Thus the time and space complexity of Algorithm VI-3 are both O(constant). 
(See Figure 20 and 21.) 
5. Time and Space Complexity of The High-Cost-Exterior-Goal-HCA-OPM Algorithm 
Algorithm VI-4 constructs the planar partition for a region with higher cost than the surrounding ter- 
rain with a goal point outside the region. It has exterior boundaries which are similar in number to those 
generated by an obstacle, except that there may be as many as three opposite-edge boundaries. Thus, by the 
same reasoning as for obstacles, the construction of exterior boundaries has worst-case time and space com- 
plexity of O(n). 
However, the interior boundaries are more time-consuming in the worst case, because of the way 
boundaries may intersect. (See Figures 22, 23, 24, 30, 31, and 32.) Each of the n HCA vertices is associated 


with an interior boundary. In the worst case, each pair of these boundaries intersects and a third boundary 
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begins at the intersection point, giving n/2 new boundaries, and each pair of new boundaries intersects and 
another begins, for n/4 new boundaries at the third level, and so on until a final boundary occurs which con- 
nects all the others. In this case, there are n+n/2+n/4+n/8+...+1 boundaries. There are in the limit n/(1- 1/2) — 
2n boundaries. 

There does not appear to be a simple way to determine for a boundary which of the two adjacent 
boundaries will be paired with it. An iterative check which accomplishes this is outlined in procedure pair- 
and-merge-bdrys under Algorithm VI-4, (see Section A4 of Chapter VI and Figure 30). This procedure takes 
at worst (in a very pathological case), n-2 passes through the inner ("while PairedBdrySet is changing") loop, 
which itself processes n boundaries ("for all Bi j..."). The outer (“while BdrySet is changing") loop, which 
checks for intersections by newly propagated boundaries with already-paired boundaries, could also take O(n) 
passes in the worst case. Thus procedure pair-and-merge-bdrys has worst-case time complexity of O(n’). 
This measure dominates the O(n) complexity of the exterior boundaries, and so the worst-case time complexity 
of Algorithm VI-4 is O(n’). The space complexity is O(n) because at most 2n interior boundaries, n-2 shadow 
boundaries, and n-2 portions of opposite-edge boundaries exist. 

6. Time and Space Complexity of The High-Cost-Interior-Goal-HCA-OPM Algorithm 

Algorithm VI-5 constructs the OPM for a high-cost HCA with an interior goal point. It has much 
lower time complexity than the high-cost, exterior-goal case, because the interior does not have a number of 
intersecting boundaries from which more boundaries may emanate. In fact, for each vertex, at most one ex- 
terior and four interior boundaries are generated, as well as additional boundaries for each pair of visible edges 
and each interior opposite-edge boundary. Both the exterior visible-edge boundaries and the exterior opposite- 
edge boundaries display the same behavior as obstacle opposite-edge boundaries, so that all of them together 
have no more than O(n) segments. The only iterative loop in the algorithm is the outer one which processes 
each of the n vertices, so the overall worst-case time complexity is O(n), as is the space complexity. (See Figure 
25.) 

7. Time and Space Complexity of The Low-Cost-Exterior-Goal-HCA-OPM Algorithm 

Algorithm VI-6 constructs the OPM for a HCA of lower cost than the surrounding terrain and an ex- 
terior goal. This algorithm generates at most four boundaries per HCA vertex. Although there are interior boun- 


daries similar to the high-cost, exterior-goal case where much computing effort was required to construct them, 
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in this case they are never mutually intersecting. Thus the entre algonthm has time complexity O(n). The 
space complexity is also O(n). (See Figure 27.) 
8. Time and Space Complexity of The Low-Cost-Interior-Goal-HCA-OPM Algorithm 
Algorithm VI-7 constructs the OPM for a HCA with lower cost than the surrounding terrain, and a 
goal inside the HCA. This is the simplest of the four HCA cases, because there are exactly two linear boun- 
daries emanating from each HCA vertex. Thus the time and space complexity is O(n). (See Figure 26.) 
9. Time and Space Complexity of The Multiple-Connected-River-Segment-OPM Algorithm 
Algorithm VI-8 constructs an OPM for multiple connected river segments. The time complexity of 
this algorithm depends on how many "event points" and new boundaries occur at each segment. An event point 
occurs ona river segment at each place that a boundary intersects it and denotes a point at which the algorithm 
must check for a continuation of the boundary on the other side of the segment. Since a river segment’s boun- 
daries will only intersect ide segments in its shadow, the worst-case time complexity happens when the river 
"doubles back" on itself. Consider a sequence of connected river segments as in Figure 34. In this example, 
the closest two river segments to the goal, and each subsequent pair of segments, are positioned so as to cast 
two shadow boundaries which create event points on the next segment. Since in this example, the cost of the 
river is so small that each river-crossing boundary begins "outside" any event points on the segment and does 
not intersect any shadow boundaries, the shadow boundaries all continue to the next level of river segments. 
At the first level, four boundaries begin, and at each subsequent level, there are three new boundaries plus the 
continuation of boundaries from previous levels associated with event points. The result is that on each river 
segment, say at level 1, there are 31+1 possible boundaries generated. So for a sequence of river segments with 
n vertices, it is possible to have Lisl ton/2 (31+ 1) = 3n^/8 - 7n/4 total boundaries over the entire set. Thus the 
worst-case time complexity of Algorithm VI-8 is O(n?). Since there are O(n’) boundary segments, the worst- 
case space complexity is also O(n’). 
10. Time and Space Complexity of The Multiple-Feature-Divide-and-Conquer-OPM Algorithm 
Algorithm VI-9 is the algorithm which takes OPM’s for individual decomposable terrain features and 
merges them into one OPM. It uses the divide-and-conquer paradigm, and spends O(n) time dividing the map 
at each stage of size n, by standard median-finding algorithms from computational geometry. Let the time 


complexity of the algorithm itself be expressed as T(n). Then the recursive application of the algorithm to both 
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halves of the map will take 2T(n/2) time. Thus the dividing, recursion, and merging will take T(n) = O(n) + 
2T(n/2) + O(f(n)), where f(n) is the time complexity of the merge step. 

The procedure merge-opms is very similar to procedure pair-and-merge-bdrys associated with Al- 
gorithm V-4 for high-cost, exterior-goal HCA OPM’s, which joined the interior boundaries and propagated 
new ones as needed. It is subject to the same possibility that multiple levels of newly-propagated boundaries 
may occur, and has the added complexity that for each boundary truncated in one of the subordinate OPM's, 
the procedure intersect-and-merge must be performed to reconstruct any other boundaries which previously 
intersected the truncated boundary but no longer do so. By the same reasoning as paragraph 4 above, even as- 
suming that procedure intersect-and-merge has O(constant) worst-case time complexity, procedure merge- 
opms operates in O(n? ) time. In fact, procedure intersect-and-merge operates in O(n) time in the worst case, 
because there are at most O(n) boundaries which a boundary can possibly intersect. Thus, procedure merge- 
opms has worst-case time complexity O(n’). We note also that the base case of the recursion requires the solu- 
tion of a single-terrain-feature algorithm, which may have as much as O(n)) time complexity. Thus the 
worst-case time complexity of the entire algorithm may be stated as T(n) S O(n) * 2T(n/2) O(n^, or 


T(n) S 2T(n/2) + O(n* 


for T(1) S O(m), where m is the largest number of terrain-feature vertices which occur in a high-cost, ex- 
terior-goal HCA. Expanding this recurrence relation, gives, by induction on the depth i of the recursion, that 
for some constant c1, l 

T(n) S pi T(n/2') + cin (1 - 2€ 
Let n 2 2*, assuming that k is an integer. Then at the last splitting step, i=k, and we have that 


T(n) S 2*T(1) + cin (1 - 2 


But for the base case, we have that T(1) S com? for some constant c2, so 
T(n) S room? + cin «(1 - 1/271) 


3 


T(n) S conm™ + cin’ - 8 cin. 


Since m S n, Algorithm VI-9 has worst-case time complexity T(n) = O(n’). 
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C. EMPIRICAL PERFORMANCE OF THE ALGORITHM IMPLEMENTATION 

The high-cost, exterior-goal case, was implemented as a proof-of-concept program. The high-cost, ex- 
terior-goal HCA was chosen because it was the most complex of the seven cases and incorporated most of the 
types of boundaries. The implementation was not intended to be particularly efficient, but was primarily 
designed to corroborate tbe shapes of various boundaries when compared with multiple runs of a point-to- 
point weighted-region path-planning implementation by Richbourg [Ref. 21]. Figures 22, 23, and 24 repre- 
sent results of the OPM implementation overlaid on vectors representing the initial directions of a dense 
sampling of optimal paths from Richbourg’s "Snell’s Law" program. OPMs of fairly simple complexity such 
as the above three figures took four to six minutes apiece to construct, not counting the time necessary to find 
optimal paths from each terrain-feature vertex using Richbourg’s point-to-point path-planner [Ref. 21]. This 


implementation was done in C-Prolog ona VAX 11/785 running under BSD 4.3 Unix. 
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VIN. CONCLUSIONS 


A. GENERAL 

In this research we developed two approaches to the construction of a planar partition for optimal-path 
maps (OPM). The first is an extension of the grid-based wavefront propagation algorithm for point-to-point 
path planning, for which we implemented and analyzed three versions. The second is based on spatial reason- 
ing about how optimal paths behave in the presence of terrain features, leading to a divide-and-conquer algo- 
rithm. We assume that paths lie in free terrain consisting of five types of regions: homogeneous-cost 
background, convex polygonal obstacles, piece wise-linear rivers with a fixed crossing cost, piece wise-linear 
roads with a constant cost-rate, and convex homogeneous-cost areas. Additionally, we assume that no two fea- 
tures share a vertex. We assume that the mobile agent is of negligible size with respect to the surrounding ter- 
rain, and that the terrain is fixed and known. 

Point-to-point path-planning algorithms require anywhere from O(n? log n) time for binary terrain 
(visibility-graph methods [Ref. 1]) to O(n’L) time for homogeneous-cost areas (continuous-Dijkstra algorithm 
[Ref. 15]), where n is the number of terrain-feature vertices and L ts a measure of the precision of the problem 
representation. One way to decrease the amount of run-time complexity of path-planning at the expense of in- 
creased preprocessing time and increased storage requirements is to construct optimal-path maps (OPM) which 
group optimal paths from all start points on a map with respect to a goal point by partitioning the plane into 
regions whose paths behave similarly. At run-time standard point-location techniques from computational 
geometry can be used to locate a start point in a region of the OPM in O(log n) time, and the optimal path can 


be reconstructed based on the known behavior of paths in the region. 


B. COMPARISON OF WAVEFRONT-PROPAGATION TO SPATIAL- REASONING 
APPROACHES TO OPM CONSTRUCTION 

The spatial reasoning approach to optimal-path-map construction is clearly preferable to wavefront 
propagation for applications requiring low error in the cost of the solution path compared with the cost of the 


actual optimal path. Otherwise, the wavefront-propagation approach using the diverging-path version seems 
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preferable because it does not depend on the labeling of vertex or edge cells, and is simpler than the exact al- 
gorithm, when the cost of constructing the optimal-path tree is included. The most accurate wavefront-propaga- 
tion OPM algorithm, the vertex-edge version, requires an additional preprocessing phase which fits polygons 
to grid-based terrain features and assigns vertex and edge labels to cells. This terrain preprocessing is also 
necessary in the spatial-reasoning approach used on large-scale cross-country terrain data, because Defense 
Mapping Agency provides data in the form of 25 meter or 12.5 meter square grid cells from which the polygonal 
terrain features of the spatial-reasoning approach must be derived. Since implementation of wavefront propaga- 
tion is simpler than the exact-OPM divide-and-conquer algorithm, it may be preferable in applications which 
can afford the 7.6% inaccuracy to use the vertex-edge version of wavefront propagation. 

While wavefront propagation would seem to be preferable if accuracy is not a factor, it should be noted 
that the complexity of wavefront propagation is based on the number of cells in the input map, not the num- 
ber of terrain-feature vertices, so the two time complexity measures are not precisely comparable. However, 
for a grid-based map of O(m) cells, with a corresponding polygonal map of v vertices, if it could be said that 
the frequency with which a cell includes a vertex would be constant as tbe size of the map increased, v would 
increase linearly as a function of m. By this reasoning, we could expect a typical polygonal map for a grid with 
m cells to have O(m) vertices, so the measures are approximately comparable. 

Actual average performance could give different results from worst-case analysis. Since the spatial- 
reasoning-OPM divide-and-conquer algorithm was implemented only for one of the seven cases as a test-of- 


concept instrument, actual performance tests of the exact-OPM algorithm were not possible. 


C. USEFULNESS OF THE OPM APPROACH TO PATH PLANNING 
Since the OPM approach to path planning trades preprocessing time and increased storage for improved 
speed at run-time, it will be useful in applications which require real-time response to a path-planning query, 
such as autonomous-vehicle or missile path-planning, or where multiple queries over the same terrain are ex- 
pected, for example, in a terrain-analysis decision aid for tactical military units. 
Two major objections to the OPM approach are its preprocessing time and its storage requirements. Cer- 
tainly preprocessing will take longer than current path-planning methods. However, the non-automated ap- 


proach to terrain navigation in many domains, which has been to prepare paper maps well ahead of time for 
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distribution to users, could serve as a model for OPM preprocessing, wherein an organization such as Defense 
Mapping Agency could devote centralized resources to the preprocessing phase and distribute standard OPM 
databases so that field units or vehicles would have to devote resources only to the run-time phase. 

A second objection to the OPM approach is the need for increased storage. However, the cost and com- 
pactness of storage media is constantly being reduced by research and development efforts. OPM databases 
could be recorded on optical disks or "digital paper”, allowing space for a whole array of OPMs covering an 
approximation of the four-dimensional solution for a given geographical area. A typical OPM for an area of 
20 by 20 kilometers might include on the order of 800,000 boundary segments (100 vertices per square 
kilometer times 400 square kilometers giving on the order of 40,000 boundanies, times 20 segments per bound- 
ary), each requiring two points of two coordinates each, or 3.2 megabytes of storage. For a four-dimensional 
array of OPM’s representing all optimal paths from any start point to a sampling of perhaps 10 goal points per 
square kilometer, or 4,000 OPMs, 12.8 gigabytes would be required. As of 1989, 5-1/4-inch disks using digi- 
tal-paper technology are commercially available which store | gigabyte each [Ref. 45]. The approximately 
thirteen such disks needed to store a full set of OPMs would be easily transportable. A library of OPMs for 
various potential areas of operation could be maintained, for example, much as libraries of paper maps are 


maintained. 


D. AREAS FOR ADDITIONAL RESEARCH 

The terrain -— assumed herein do not include non-convex polygons, even though much real-world ter- 
rain would be difficult to model accurately without them. Thus, it is important to determine how to incorporate 
non-convex polygons into the optimal-path map algorithms presented. With the unifying view of regions and 
boundaries based on region cost functions, this task seems attainable with additional research. 

The boundary between regions where one or both regions have paths which cross multiple Snell's-Law 
edges en route to a region root which is a point has not been characterized analytically. In the current algo- 
rithm, it is proposed that such boundaries be approximated by hyperbolas, and it is thought (without proof) 
that such an approximation introduces very little error. However, a better approximation could be used to in- 
tersect with other cost functions to determine boundaries on a much less ad hoc basis than is done in this dis- 


sertation. 


152 


One specific place in which improvement in efficiency could have great effect on the overall exact-OPM 
algorithm is in constructing the interior boundaries of an extenior-goal, high-cost HCA in less than O(n’) time. 
OPM’s for all six other primitive terrain-features can be constructed in O(n) or less time, and for multiple con- 
nected river segments in O(n’) time, and it is this single case which drives the divide-and-conquer algorithm’s 
worst-case time complexity to O(n’). In addition, a merge procedure for the exact-OPM divide-and-conquer 
algorithm which had efficiency more in line with that of Voronoi diagram construction would improve over- 
all performance. 

A four-dimensional solution is needed in order to make the OPM approach useful in most domains. The 
solution consistent with the approach herein is to create multiple OPM’s for a sampling of goal points in the 
plane, and then choose the OPM to use at run-time based on the proximity of the query goal point to the goal 
point of one of the OPM’s. Perhaps more efficient methods exist which would characterize boundaries be- 
tween four-dimensional regions in a space of all start and goal points, a conceptual generalization of the two- 
dimensional solutions reported here for start points and a fixed goal. In other words, the four-dimensional 
hyperplane would be partitioned into regions whose paths were similar. 

It would be very instructive, as well as practical, to implement a complete two-dimensional path-plan- 
ning system, from construction of an optimal-path tree for the four types of terrain used herein through OPM 


construction, and including a run-time system to accomplish point location and path reconstruction. 
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APPENDIX A - THEOREMS 


A. OVERVIEW 


In this appendix the theorems which form the basis of the research reported herein are presented, along 
with associated lemmas, corollaries, and fundamental assumptions. The theorems follow in the same order in 
which they are discussed in the body of this report, and are numbered by chapter and theorem. Lemmas and 
corollaries are numbered as extensions of the theorem to which they apply. First, some notation used in this 
appendix and throughout the report is presented. Then three theorems and a fundamental assumption with three 
associated corollaries are presented which provide a theoretical foundation for the discussions of Chapter I. 
Next six theorems are presented which state the basic boundary equations as developed by the unifying view 
of region cost functions. Seven theorems from Chapter V, one for each of the three terrain-feature types 
obstacle, road segment, and river segment, and four for the four cases of the homogeneous-cost area, are 
presented. The definition of homogeneous-behavior region used in this appendix is the set of all points whose 


optimal paths have the same path list. 


B. NOTATION 


The following notation is introduced for use with respect to path-planning. 


E Descrint 
P A point in Euclidean n-space. 

PQ The straight-line segment from P to Q 

(PQ) A feasible path from P to Q 

(PQ): The i? feasible path from P to Q 

(PQ)* Optimal path from P to Q 

OPL(P) Optimal-path list (sequence of edges and vertices encountered) of P. 


OPL(P) = [P,QIOPL(Q)] The path list from P through Q shown in Prolog-style list notation 
(1.e., lists are enclosed in braces, commas separate elements, and the 
entry following a vertical line ("I") is the "rest" of the list). 


(PQ) The cost (weighted distance) from P to Q via path (PQ)i. 
d(P,Q) The Euclidean distance between P and Q. 
((PQ)i(QR)j) A feasible path from P through Q to R. 
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(PQ)iC ((PQXY(QR)j) Set notation applies to paths as if to their path lists, treating them as 
(QP)i Z ((PQX(QR)j) ordered sets, e.g., (PQ); is a sub-path of ((PQ)i(QR)j), but 
(QP)i is not a sub-path of((PQJi(QR);). 
Pe (PQ)i Points are considered elements of paths. 
(PQ) = (RS); if (PO) (RS)j and (RS)jS (PQ)i Two paths are equal if Vk, the k^ 
elements of the path lists of the two paths are the same. 


Cpq The cost (weighted distance) of a path from point P to point Q 

ri The cost rate in region i. 

01 Angle of incidence or refraction of a path across a Snell's-Law edge. 
Y= sin" (1/12) Critical angle with respect to a Snell’s-Law edge separating 


regions of cost-rates r] and r2, where r1 « r2. 

VAGB The characteristic wedge with vertex at G and edges through A and B. 
This is defined with respect to road segments such that G 1s the goal 
point, À and B are points on the line of the road segment, ray GA forms 
angle TU/2 -- V with the segment, and ray GB forms an angle 7/2 — y 
with the segment, where W is the critical angle as defined above. 


C. BASIC THEOREMS 


THEOREM I-1.Given optimal path (AB)*, VP € (AB)*, (PB); - (PB)* if (PB); C (AB)*, i.e., any sub- 
path of an optimal path is also an optimal path. (The generalization of this concept is known in some contexts 


as the principle of optimality, the dynamic programming principle, or the Markovian property [Ref. 46].): 


PROOF I-1:(Proof by Contradiction) Given points A and B and path (AB) = (AB)* such that I(AB)*! =c*, 
points P and Q such that P € (AB)* and Q € (AB)*, where paths (AP), (PQ) and(QB) are such that 


((AP)(PQ)(QB)) = (AB)* with (PQ)(QB)I 2 ci, and Q' € (AB)*. (See Figure 35.) 


Assume J (PQ’) and (Q’B) such that I((PQ’)(Q’B))I = ci^, and c1/« ci. Then d (ABY? 2 ((AP(PQ^(Q'B 
)) such that (AB)2l 2 c* - c1  c1'. But c*-c1+c1’ <c* , so I(AB)zl < I(AB)*I, which contradicts the op- 


timality of (AB)*. + 


THEOREM I-2. In terrain consisting of a homogeneous-cost background on which is placed homogeneous- 
cost polygons, optimal paths change directions only at terrain feature vertices and edges. Note that the terrain 


defined in Chapter II, Section E, are specializations of this type of terrain. (See Figure 36.) 
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Figure 35 
Principle of Optimality for Path Planning 
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Figure 


Optimal-Path Turn Points 
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PROOF I-2: Consider point X on optimal path (AB)*, with Pe (AB)* and Qe (AB)* arbitrarily close to X 
such that ((PX)(XQ)) C (AB)*, 1.e., P and Q are on opposite sides of X on path (AB)*. Assume P, X, and Q 
are not colinear (1.e., X is a turn-point). Among terrain consisting of line segments and polygons, P and Q can 


be made close enough to X so that there are only four possible placements of P, X, and Q: 


(1) P, X, and Q are in areas of equal cost, X is not coincident with a terrain feature vertex, and line 


segment PQ does not intersect any terrain feature edge. 
(2) P, X, and Q are in areas of equal cost, and X is coincident with a terrain feature vertex. 


(3) X is in an area of equal cost with either P or Q, but not both. Assume without loss of generality 
that P and X are in an area of cost rı and Q is in an adjacent area of cost r2. Additionally, X is not 
on a terrain feature edge, (PX) does not cross any edges, and (XQ) crosses exactly one edge, the 


edge between the two areas of concem. 


(4) X ison the terrain feature edge separating an area of cost rj of which P is a member and adjacent 


area of cost r2 of which Q is a member. Additionally, neither (PX) nor (XQ) cross any other edges. 


Assume case 1. ((PX)(XQ)) = (PQ)* by the principle of optimality. So ((PX)I + (XQ)I € PQI, because 


of the optimality of ((PX)(XQ)) (i.e., the cost from P to Q via X is less than the straight-line cost from P to Q). 


So it is also true that PX)l/r - (XQ)l/r € IPQI/r. Now VR and S, the Euclidean distance between R and 
S is less than or equal to the distance along any general path between R and S. So (PX)l/r 2 IPXI/r and 
(XQ)l/r 2 IXQUr. (By the notational convention that |(RS)I is the weighted distance, or cost, between R and 
S, I(RS)l/r is the Euclidean distance of (RS) if (RS) lies entirely in an area of cost rate r.) Therefore [IPXI/r -- 
IXQVr < [PQl/r. But since P, X, and Q are not collinear, this violates the triangle inequality, so case 1 is not 


possible. 


It is clear, by example, that case 2 is possible. Consider X coincident with the corner of a rectancular 
obstacle O, with P and Q not intervisible, but closer to X than to any other vertex of O. (PX XQ) = (PQ)* in 


this case, demonstrating that case 2 is possible, i.e., that optimal paths may turn at terrain-feature vertices. 
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Assume case 3. Let Y be the point at which (XQ) crosses the edge. Then by the same reasoning as for 
case 1 above, it is contradicted that P, X, and Y are not collinear, i.e., X is not a tumn-point, so case 3 is not 


possible. 


Richbourg [Ref. 20] proves the applicability of Snell's Law to describe the angles of incidence and refrac- 
tion of an optimal path across an edge as in case 4, demonstrating that this case is possible, i.e., that optimal 


paths may turn as they cross terrain-feature edges. 


Thus the only turn-points in optimal paths in terrain consisting of homogeneous-cost polygons on a 


homogeneous-cost background are coincident with terrain feature vertices or edges. @ 


ASSUMPTION I.-3, General-Position Assumption: No terrain-feature vertex or edge interior lies on a non- 
trivial homogeneous-behavior-region boundary, i.e., a homogeneous-behavior boundary other than those of 
the homogeneous-behavior region of which the vertex or edge is the root, or the terrain-feature edges inci- 


dent upon the vertex or edge. 


COROLLARY I-3.1:There is a unique optimal path from each terrain-feature vertex and edge interior. 


PROOF I-3.1: (Proof by Contradiction) Assume that there were two optimal paths from a terrain-feature ver- 
tex or edge interior. Then the vertex or edge would lie on a non-trivial boundary, by the definition of a bound- 


ary. But this contradicts Assumption I-3. $ 
COROLLARY I-3.2: There is a unique homogeneous-behavior region root associated with each 


homogeneous-behavior region, where a region root is the first vertex or edge crossed by optimal paths which 


start in the region. 
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PROOF I-3.2: From the definition of ahomogeneous-behavior region as the set of points whose optimal paths 
to a goal point have the same path list, the path lists from all start-points in a region are identical, so the first 
elements of the path lists are also identical. Thus there is only one root per homogeneous-behavior region. As- 
sume there existed two homogeneous-behavior regions which shared the same root. Since a region consists of 
all points with identical optimal-path lists, then JOPL1 = [EilResti] andJOPL2 - [EilRest?] such that Rest) 
# Rest2. By the definition of a boundary, E1 would thus be on the boundary between region 1 and region 2. 
By Theorem I-2, E; must be a terrain-feature vertex or edge, but this contradicts the general-position assump- 


tion. Thus there is only one homogeneous-behavior region per root. + 


DEFINITION I-3.3:A region R is star-shaped if IP € R such that VQ € Rand VX € PQ, XER. 


COROLLARY I-3.4:Homogeneous-behavior regions are star-shaped with respect to their region roots. 


PROOF I-3.4: By the definition of a homogeneous-behavior region, all start-points in the region have the 
same optimal-path list, with, by the definition of a region root, the same first element. By Theorem I-2, the 
optimal path from each start-point to the root is a straight line segment. By the Theorem I-1, all points along 
the line segment have optimal paths lying along the line segment, so sharing the first element of their optimal- 
path lists as well, and so by Corollary I-3.1 sharing optimal-path lists. Thus all points along each such line seg- 


ment lie in the same homogeneous-behavior region. 4 


THEOREM I-4: Given a two-dimensional map of a finite number of linear and polygonal terrain features 


and a goal-point, it has a unique optimal-path tree. 


PROOF I-4:Given a two-dimensional map M of linear and polygonal terrain features and a goal G, each point 
S in M either has an optimal path, i.e., the feasible path of minimum cost, or else has no feasible path to G. If 
it has an optimal path, then by the definition of an optimal-path list and Theorem I-2, it also has an optimal- 
path list. If it has no feasible path, it is associated by convention with the optimal-path list [[],G], where {J rep- 


resents the null list. Define the relation R 2 ((P1,P2) | OPL(P1) 2 OPL(P2)], i.e., two points are related by R 
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if and only if their optimal-path lists are identical. Since identity is an equivalence relation, so is R, so R com- 
pletely partitions the plane into sets of points with identical optimal-path lists. Since this is the definition of a 
homogeneous-behavior region, the plane is completely partitioned into homogeneous-behavior regions. Since 
there are a finite number of terrain-feature vertices and edges, there are a finite number of homogeneous-be- 


havior regions. 


A directed acyclic graph can be used to represent a partial order among its nodes [Ref. 36]. A partial order 
of a set S is a binary relation U such thatV ae S, aUais false , i.e., U is irreflexive, and Va, b, andc € S, 
if aUb and bUc, then aUc , i.e., U is transitive. [Ref. 36] The set of all homogeneous-behavior regions in map 
M is partially ordered by their optimal-path lists as follows. Let U = {(P1,P2) | P1 CP2}, i.e, optimal-path list 
P¡ precedes optimal-path list P2 in the partial order if P1 is a proper subset of P2. Because the relation "proper 
subset" induces a partial order on a set whose elements are sets, the relation U also induces a partial order on 
the set of optimal-path lists, and hence on the set of homogeneous-behavior regions, of map M with respect 
to goal G. In fact, because of the uniqueness of optimal-path lists from region roots, a specialization of the 
directed acyclic graph, the tree, may be used to represent the partial order of homogeneous-behavior regions. 


We call this tree an optimal-path tree, because it represents the optimal paths of map M. 


Now consider the homogeneous-behavior regions in M with optimal-path lists consisting of only one ele- 
ment. Since all optimal-path lists for optimal paths to G have by definition the point G as their last point, and 
by the definition of homogeneous-behavior regions as the set of points with identical optimal-path lists, there 
is only one region with a single element in its optimal-path list, the region with the optimal-path list [G], and 
[G] is a subset of all other optimal-path lists. Thus [G] precedes all other optimal-path lists in the partial order, 
and so is the root of optimal-path tree Tm.G, the optimal-path tree associated with map M with respect to goal 


point G. 4 
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D. PROOFS FOR BASIC BOUNDARY EQUATIONS 


THEOREM V -0.1: (Boundary between two regions with paths which go initially to two different points) 
Given goal point G and two adjacent homogeneous-behavior regions of cost rate r whose region roots are 
points V1 and V2, costs c1 = I(V1G)*! and c2 2 (V2G)*l (the costs of optimal paths from V1 and V2 respec- 
tively) where without loss of generality it is assumed that c2 » c1, the boundary between regions 1 and 2 is a 


portion of the hyperbola branch which is closer to V2 than to V1, and is described by 


(Equation 1) x? y? 2 


where a z (c2 - c1)/2, c 2 r d(V1,V2), and b? =c? - as and where the x-axis is oriented along the line segment 


V1V2 with the origin at a point half-way between V and V2. 


PROOF V-0.1: (See Figure 37.) By the definition of a homogeneous-behavior region, points in region 1 all 
have the same path list, whose first element is V1. Thus the first leg of an optimal path from any point P in 
region 1 is PV). Similarly, the first leg from any point P in region 2 is PV2. The boundary between regions 1 
and 2 is the set of points P such that cı + IPV11 = c2 + IPVal. Therefore PV]! - IPV2I = C2 - c1. From basic 
analytical geometry, the set of points with constant absolute difference of distances from two foci is a hyper- 
bola. Since the above equation describes the signed difference of the two distances, it represents one branch 
of the hyperbola, the branch such that IPV;| > PV2l. Thus the branch on which P lies is closer to V2 (the ver- 


tex with the higher-cost optimal path) than to V1. 4 


THEOREM V -0.2: (Boundary between a region with paths which go initially to a point, and a region with 
paths which go to and travel along a linearly-traversed-edge, or "road") Given goal point G and two adjacent 
homogeneous-behavior regions with cost-rate ro, one region having point U as root and the other having linear- 
ly-traversed edge VW as root, where VW isa sub-segment of some terrain-feature edge such that OPL(V) = 
[W | OPL(W)] and the cost-rate along the edge is rvw, (for example, a road segment where paths leave the road 


from point W), the boundary between them is a portion of the curve 
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(Equation 2) y =4px, 


where p is defined as follows. From W extend a ray WWa away from region 2 (i.e., no point on WWa lies in 
region 2) such that ZVWWa - 172 -- V, and the distance between W and Wa is (Cw - Cu)/ro. Let point Ud be 
the point such that line UUs is parallel to WWa, and the line UaWa is perpendicular to line UUa. Let point O 
be the point on line UUs equidistant between U and Ua. Then the coordinate axes are the line UUa (x-axis with 
U in the positive x direction) and the line through O parallel to UaWa (y-axis with Wa in negative y direction), 
and p = (€w - Cu)/ro , where Vf — sin  (rvw/ro) is the critical angle, cw - \(WG)*I, and cu = (UG)*! (the costs 
of optimal paths to goal point G from W and U respectively). Note that the x-axis is the parabola axis and the 


line UaWa is the directrix. 


PROOF V-0.2: (See Figure 38.) The boundary between regions 1 and 2 is the set of points P such that the 
cost of optimal paths which go through U and through W are the same. The optimal path through U begins 
with the line segment PU and continues with (UG)* and has total cost cu, while the optimal path through W 
starts with the line segment PQ at cost-rate ro, where Q is a point on VW between V and W inclusive, con- 
tinues along line segment QW at cost-rate rvw, and ends with path (WG)* with total cost cw. Thus, the bound- 
ary is described by the equation ro d(P,U) + Cu = ro d(P,Q) + rvwd(Q,W) + Cw, or rearranging terms, d(P,U) = 
d(P,Q) + siny d(Q,W) + (cw - Cu)/ro . Now ZPQW = 1/2 + Y for a road, as shown by Rowe [Ref. 2]. Ex- 
tending the line PQ to point Pa, as Figure 38 shows, the right-hand side of the above equation is the straight- 
line distance from P to Pq . Let line D lie perpendicular to PQ, through Pa. By Figure 38, line D is a distance 
(Cw - Cu)/ro from W. Thus, the above equation states that P is equidistant from point U and line D, the defini- 
tion of a parabola with the form of Equation 2, where the coordinate axes are the lines UU4 and D as shown, 


and p is half the distance from U to Ua. 4 


THEOREM V-0.3:(Boundary between regions having paths which go to and travel along two different linear- 
ly-traversed edges, or "roads") Given goal point G and two adjacent homogeneous-behavior regions with cost- 
rate ro, one region having linearly-traversed edge XY as root and the other havin g linearly-traversed edge VW 


as root, where XY and VW are sub-segments of terrain-feature edges such that OPL(X) = [Y | OPL(Y)], 
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OPL(V) = [W 1 OPL(W)] and the cost-rates along the edges are rxy and rvw respectively, (for example, two 
road segments where paths leave road XY from point Y or leave road VW at point W), the boundary between 
them is a segment of line L defined as follows. Let Dzy be the line which forms angle Wry with line XY, is 
distance cy from point Y, and lies on the side of XY which does not include the region of which XY is the 
root. Let Dvw be the line which forms angle Vvyw with line VW, is distance cw from point W, and lies on the 
side of VW which does not include the region of which VW is the root. Let Po be the point of intersection of 
Dxy and Dv, and let (X be the angle between line XY and line VW. Then the boundary lies on line L, which 


is the line through point Po which lies at an angle (0 + Wyw + Wxy)/2 with both Dxy and Dyw. 


PROOF V-0.3:(See Figure 39) Consider the set of points P with two optimal paths, OPL1 = [Q1, Y | OPL(Y)], 
and OPL2 = [Q2, W | OPL(W)], where Q1 and Q are the points at which the paths first enter edges XY and 
VW respectively. The cost of OPE; is ro d(P,Q1) + sin(YWxyd(Q1,Y) + cy and the cost of OPL2 is ro d(P,Qz2) + 
sinYWvwd(Q2,W) + cw. By Figure 39, these are the perpendicular distances of P from two lines Dxy and Dyw, 
defined as follows. Dxy is the line which forms angle Vxy with XY, is distance cy from point Y, and lies on 
the opposite side of XY from the region of which XY is the root. Dyw is the line which forms angle Vvw 

with VW, is distance cw from point W, and lies on the opposite side of VW from the region of which VW is 
the root. From analytic geometry, a set of points equidistant from two lines is a line. The point Po, where Dxy 
and Dvw intersect, is distance zero from both lines, and so lies on line L which includes the boundary. By basic 
plane geometry, the line equidistant from two intersecting lines is the line which bisects the angle between 
them. The angle between Dzy and Dvw is (0. + Yxy + Wvw), so that line L forms angle (0 + Yxy + Wwvw)/2 


with both Dxy and Dyw. 0 


THEOREM V-0.4: (Boundary between two regions having paths which cross two different edges.) Given 
goal point G and two adjacent homogeneous-behavior regions with cost-rate ro, one region having Snell’s- 
Law edge VW and the other having Snell’s-Law edge XY, where paths which cross VW go directly to point 
U at cost-rate rvw, paths which cross XY go directly to point Z at cost-rate rxy, and where the total cost from 


U to the goal is cu and from Z to the goal is cz, the boundary between them consists of points P such that the 
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distance from P to edge VW is x2, the distance from VW to U is x1, the distance from point P to edge XY is 


y2, and the distance from XY to Z is yi, where the seven equations of Equation Set 4 are satisfied. 


(Equation Set 4) dı siny do sinB 
so a , yli ==- 
cosQ1 cos03 


> 


docos(93 - B) dicos(@1 - y)cos(O4 + 01) 
dicos(91 - Y) cos(02 * €), cos82 i es 
cosÜi 





_ sin& ( ( ) 
y2 = ~sinOa cosB2 i. cos(B2 + )cos(O4 + &) 
cosU2 cosU4 
do sinctcos(83 - 2) _ dicos(@1 - Y cos (04 + 01) 
— cosU2 cosU3 COSU, cosU4 
d E (cos(02 + 01) cos(U4 4 QX) 
cosU2 cosUa 

Boundary Condition: IvwX1 + 10X2 = TxyY1 + T0y2 
Snell’s Law for edge VW: rvwsin0 1 = rosin02 
Snell's Law for edge XY: rxySinO3 - rosinO4 


where do, di, &, B, and Y are constants as shown in Figure 40, x1, x2, y1, and y2 are distances, and O1 and 03 


are the dependent and independent variables. 


PROOF V -0.4: (See Figure 40.) Given two adjacent regions with point P on their boundary, and given that 
the optimal paths from region 1 cross edge VW obeying Snell's Law, and then go through point U en route to 
the goal, and that optimal paths from region 2 cross edge XY obeying Snell's Law, and then go through point 


Z en route to the goal, with costs as shown, the boundary condition is 


(4-1) TvwX1 + I0X2 7 Ixyy1 ^ I0y2. 
The Snell's-Law conditions across edges VW and XY are 


(4-2) rvwsin9 1 = rosinO2 and rxysinO3 — rosinO4 , 
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Applying trigonometric identities to the triangles UQ1l and ZQ21 gives the following for xı and y1. 


(4-3) di sin Y 


>. do sinB 
Leg 


dedit = 
ney cos 05 . 


The law of sines applied to AUQII gives that 


(4-5) b sin( 91 - y) 
siny 


Substituting the expression for x1 in equation 4-3 into 4-5 gives 


(4-6) di cos(01 - y) 


cos0, 


d2 
The law of sines applied to AZQ2I gives 


(4-7) y1cos(05 - D) 


d3 = - 
i sinB 
Substituting for the expression for y1 in Equation 4-4 into 4-7 gives 


(4-8) , do cos(03 - B) 
j — LM ES 
cos03 


Applying trigonometric identities to the right triangle whose hypotenuse is the line segment PQi gives 


(4-9) x2cos0» - dasinQ - yocos(04 + (X) . 


Substituting the expression for d3 in Equation 4-8 into Equation 4-9 gives 


(4-10) - docos(05 - B)sina cos(04 4 Q0) 


cos035 cos 02 cosQ5 
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Applying trigonometric identities to the right triangle whose hypotenuse is the line segment PQI gives 


(4-11) y2c0s04 = dasinQl - x2cos(02 + 01) . 


Substituting the expression for d2 in Equation 4-6 into Equation 4-11 gives 


(4-12) D dicos(01 - Y)sinQ x cos(02 + 01) 
us cos8 1 cos Ba cosQ4 


Substituting the expression for y2 in Equation 4-12 into Equation 4-10 and simplifying gives 


(4-13) do sinQcos(93 - 2 dycos(Qy - y? cos (04 4 (X) 
an cos0» cos03 D cosBa 
is: (cos(U» -- €) cos(94 -- Œ) 
cos0» cosa 





Substituting the expression for x2 in Equation 4-13 into Equation 4-12 and simplifying gives 


(4-14) docos( 03 - B) d¡cos(8 1 - Y)cos(Oa + a) 
— Ssin& , dicos(€1- y) cos(Q2 4 €), cost $ cosOicosO4 
ST C coso | y . _Sos(U2 + O)cos(Ga + 0) » 


COSU2 COSUA. 


Equations 4-1, 4-2, 4-3, 4-4, 4-13, and 4-14 are exactly Equation Set 4. 81 and 03 must be iteratively set and 
the results of the first four equations checked in the boundary-condition equation, since there 1s no known 


closed form for Equation Set 4. The angles 92 and O4 are determined by the Snell’s Law relations. € 
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THEOREM V-0.5:(Boundary between a region with paths which go to and travel along a linearly-traversed 
edge ("road") andaregionwith paths which cross anedge) Given goal point G and two adjacent homogeneous- 
behavior regions with cost-rate ro, one region having linearly-traversed edge VW as root, and the other having 
as root Snell’s-Law edge XY, where VW isa sub-segment of some terrain-feature edge such that OPL(V) = 
[W | OPL(W)] and the cost-rate along the edge is rvw, (for example, a road segment where paths leave the road 
from point W), and where paths which cross XY go directly to point Z at cost-rate rxy, and where the total cost 
from W to the goal is cw, and from Z to the goal is cz. The boundary between the regions consists of points P 


such that the six equations of Equation Set 5 are satisfied. 


(Equation Set 5) d3 sinB sin cos(W+ Q) sin 
= =X - X — + =r 
y cosU] 2e l'cos02 ^ ^^ ^ cos0; ar 2 


y d2(cos(02 + (sino - IvwCOS02) + rosinY cos(02 - Q0) 
oa a sin(92-Q.-W)rvwcosU2+rocos(U2 - O)(sin(G2-O-W)+ro(cosG2+cos(02 - &))) 
d3cosQ2(rosinQcos 
sin(92-Q-W)rvwceosU2+rocos (92 - O)(sin(G2-Q-W)+ro(cosG2+cos(G2 - Q))) 





_ So k e E p. - 1) (dacos(02-^y)*dacos Bcos02) 
E cosO2+cos(W+a) 
sin(02-0.-Y) 


rywcos92 + rocos(82-a)( £1) 


2 
rvwcos Dcos^02 
n + Txvsin + (co - cw)cos@ 
darosiny+ d3( a IxyS Bcos82) (Cz - Cw)cosU2 


+ ra SNCS CONGO tn 
tvwcosQ2 + rocos(82 ac E ee E 


Snell’s Law condition for edge XY: Ixy sinQ1 = ro sinO2 


Snell's Law condition for edge VW: sINY= rvw / rO 
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PROOF V-0.5:(See Figure 41.) Given two adjacent regions with point P on their boundary, and given that 
the optimal paths from region 1 go directly to edge VW and travel along 1t to point W, and that optimal paths 
from region 2 cross edge XY obeying Snell’s Law, and then go through point Z en route to the goal, with costs 


as shown in Figure 41, the boundary condition 1s 


Cry2 + TxyY1 + Cz = CrX2 + IvwX]+ Cw . 


At the two edges, the Snell’s-Law conditions are 


cvsinO2 - rxysinQi 


and siny= Tvw / Cr . 


The same type of trigonometric and algebraic reasoning used in Proof V-0.4 leads to the equations listed in 
Equation Set 5. Since there is no closed-form expression for the boundary, an approximation is computed using 
a finite number of points. The procedure for plotting a point on the boundary is to set 01, usethe first Snell's- 


Law condition to solve for 65, and then solve for x1 and x2. 4 


THEOREM V-0.6: (Boundary between two regions each having paths which cross two edges) Given goal 
point G and two adjacent homogeneous-behavior regions with cost-rate ro, one region having Snell’s-Law 
edge VW and the other having Snell's-Law edge RS, where paths which cross VW go from there at cost-rate 
Ivw directly to a Snell's-Law crossing at edge XY, and then go at cost-rate rx, directly to point Z1; paths which 
cross RS go from there at cost-rate rr; directly to a Snell's-Law crossing at edge gu and then go at cost-rate 
Itu directly to point Z2, and where total cost from Z4 to the goal is c1 and from Zo to the goal is c2, the bound- 
ary between them consists of points P such that the path distance from P to edge VW is y3, the path distance 
from VW to XY is y2, the path distance from XY to point P is y1, the path distance from point P to edge RS 
IS x3, the path distance from RS to TU is x2, and the path distance from TU to Z2 is x1, where the fourteen 


equations of Equation Set 6 are satisfied. 


173 


= "A 
¿E “iar 
.* e, 
* * 
e e 
* e 
e * 
e e ` 
e p^ * 
a * 
` , X 
: & 
^ * 
& .? » 
. 0 Y 
a seit * 
a Ss 
4 pt 
e ae 
` [t 
& ew 
a PLA 
vett 
ent : 
6 4 . 
cost-rate = 
4 + 
A . 
* 
y : 
N : 
A . 
à i 
: : 
Ll nens ss enel see aaa ON * 









eaohbdbed 


. 


IN 


Figure 41 


Boundary Between Homogeneous-Behavior Regions with a Snell’s-Law 


dge and a Linearly-Traversed Edge as Roots 


(Equation Set 6) X d7 sinf y mm ds sinpi 
| — "cos0s : y cosU1 i 
_ sind3 ame Os) _ sind B» 
a qeu Sm cosUg ) >» E GOES coso E 


x3 = MOST YU (ds. Stee . .da cos07 , dreos(Bo - Ogcos07 ) 
3 7 ^cosOsc oa JD ^ ^ sinde EHE 


_ siny Sud dscos(B1 - 81)cosO2 
13 = cos(Ba- Y) (da "cos; ^ cos ) 
qi. Y cos07 f dscos(B2 - Os)cosO4 
cos(04 - y1) E : sinOe cosUg 
cos(Us + Ol4 + Y1) 


E COS d7cos(132 - Og)cos 
d, . dacosU7 , drcos(B2- Us)cosU7 


sinU6 COSUS 
Boundary Condition: 10Y3 + Tvwy2 + TxyY1 = T0X3 + TrsX2 + Tux] 
Snell’s Law: Ios» — ys nO rosinO4 = rywsin@3 
rrssinO7 - rusinOg rosin@s = rrssinO¢6 
Trigonometric Identities: 03 = 011 - 02 062 03-07 


PROOF V-0.6: (See Figure 42.) Given two adjacent regions with point P on their boundary, and given that 
the optimal paths from region 1 cross edge VW obeying Snell's Law, then go straight to edge XY and cross 
it obeying Snell's Law, and then go through point Z1 en route to the goal, and that optimal paths from region 
2 cross edge RS obeying Snell's Law, then go straight to edge TU and cross it obeying Snell's Law, and then 


go through point Z2 en route to the goal, with costs as shown in Figure 42, the boundary condition is 


IQy3 t Ivwy2 + Ixyyl = TO0X3 + TrsX2 + TtuX] . 





Figure 42 
Boundary Between Homogeneous-Behavior Regions each with Two 


Snell’s-Law Edges as Roots 
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At each edge, the Snell’s-Law conditions are 
rvwsinO? = rxysinOj 


rosinO4 = rvwsinQs 
rrssin@7 = rmsin@g 


rosinOs 2 rrssinOe , 
Trigonometric identities applied to AV1P)P2 and AV2P3P4 give the relations 
03= 01-682 and 


O6= 03-07. 


Applying to the diagram of Figure 42 the same type of trigonometric and algebraic reasoning used in Proof 
V-0.4 leads to the equations listed in Equation Set 6. By solving for 8; and Qs, a point P on the boundary can 
be found. Since there is no closed-form expression for the boundary, an approximation is used where a finite 
number of points are plotted. Since there is no closed-form expression for 98 as a function of 81, the proce- 
dure for plotting a point on the boundary is to set O1, iteratively search for a value of Os for which the equa- 
tions of Equation Set 6 are satisfied (within some allowable error), and then trace the Snell’ s-Law path accord- 
ing to the heading for @1 using the values for y1, y2, and y3, or according to the heading for 9g using the 
values for x1, x2, and x3. Note also that the expression for Yı is not in closed form, and so must be found by 


iterative means. 4 
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E. PROOFS FOR BOUNDARIES ASSOCIATED WITH PRIMITIVE TERRAIN-FEATURE 


TYPES 


LEMMA V-1.1: If there are feasible paths from a vertex of a polygonal obstacle, then the obstacle edges con- 


stitute boundaries between homogeneous-behavior regions. 
PROOF V-1.1: Trivially true. @ 


LEMMA V-1.2: Each vertex V of an obstacle hidden edge generates a linear shadow boundary which is the 
ray lying on the line defined by V and the first point P on OPL(V), starting at V and lying in the opposite direc- 


tion from P. 


PROOF V-1.2: Note that if V joins a hidden edge and a visible edge, point P will not be on the obstacle 
perimeter by the definition of a visible edge; if V "T. two hidden edges, P will be the other vertex of one of 
the hidden edges. We prove first that there 1s a single shadow boundary associated with each hidden-edge ver- 
tex, second that no vertices other than hidden-edge vertices generate shadow boundaries, and third, that the 
shadow boundary is a ray defined as stated in Lemma V-1.2. 

First, consider point Q near V, a hidden-edge vertex. Let P be the first point on OPL(V). Then one of 
three cases holds (see Figure 43): either (a) Qa is in the obstacle interior, or (b) Qo and P are intervisible, or 
(C) Qc and P are not intervisible. Clearly, if V joins a hidden and a visible edge, Figure 43a applies, and if V 
joins two hidden edges, Figure 43b applies. Qa is nme from Qb and Qe, not by shadow boundaries, but 
by obstacle-edge boundaries. The optimal path from Qb is (QbG)* z ((QoP)* (PG)*), where (QoP)* is the line 
segment PQ». Thus the optimal-path list from Qb 1s OPL(Qb) = [P | OPL(P)]. The optimal path from Qe is 
OPL(Q-G)* = ((QcV)*(VP)*(PG)*), where (Q-V)* and (VP)* are the line segments VQe and VP respective- 
ly. Thus the optimal-path hist from Qc is OPL(Qc) = [V, P| OPL(P)]. Thus OPL(Qb) #OPL(Qb), so Qb and 


Qc are in different regions, so there is a boundary between them. 


We show secondly that no other vertices generate shadow boundaries. Assume vertex V does not join a 


hidden and a visible edge, or two hidden edges. Then it Joins two visible edges. Thus, OPL(V) does not in- 
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clude any vertices of the obstacle, from the definition of a visible edge. By Assumption I-3, V is not on a non- 
trivial (1.e., non-obstacle-edge) boundary. Consider a point Q arbitrarily close to V. Clearly, Q is either in the 
obstacle interior (call it Qa) or in its exterior (including its edges) (call it Qb). Clearly, Qa is separated from Ob 
by an obstacle-edge boundary. Now in the absence of externally-generated boundaries in the vicinity of Vi, 
Qb can be made close enough to V that it is in the same region as V, and so OPL(V) 2 OPL(Q»). Thus in the 


vicinity of V, there 1s only one exterior region, and so V does not generate any shadow boundaries. 


Thirdly, we show that each shadow boundary is a ray lying on the line defined by vertex V and P, the first 
point on OPL(V), starting at V and lying away from P. Consider a point R on ray B in Figure 43a or 43b. By 
convention, let points on B not be intervisible with P. Then (RP)* = (RV VP). Now consider R' arbitrarily 
close to R but intervisible with P. By the definition of intervisibility, (R’P)* is a straight-line segment. Since 
R’ is arbitrarily close to P, (R’P)* must be arbitrarily close to (RV VP) , and so (RV VP) must be a straight- 
line segment, collinear with P, V, and R. Since B separates the region with OPL = [V, P | OPL(P)] from the 


region with OPL z (P | OPL(P)], B must begin at V and lie away from P. € 


LEMMA V-1.3: A convex polygonal obstacle has exactly one opposite edge. 


PROOF V-1.3:First, we show that obstacle O with n distinct vertices has at least one opposite edge. Assume 
O in Figure 44a has no opposite edge. Then for any hidden edge ViVi+1, either OPL(Vi) COPL(Vi+1), or 
OPL(Vi+1) © OPL(Vi), or else ViVi+1 would be an opposite edge. Now consider vertex Vi, a vertex joining 
a hidden and a visible edge. By the definition of visible edges, VVk € O, Vk € OPL(V1). Therefore, it 
must be that OPL(V2) Z OPL(V1). Since V1 V2 is not an opposite edge, OPL(V 1) C OPL(V2). Then by in- 
duction on i, similar reasoning shows that Vi, OPL(Vi) COPL(Vi+1). Fori=n, similar reasoning shows that 
OPL(Vn) COPL(V}1). But this statement contradicts that VVk € O, Vk ¢ OPL(Vi). Therefore by con- 


tradiction, obstacle O has at least one opposite edge. 


Now assume that there are n distinct opposite edges, where n22. Choose any two opposite edges, say 


ViVi+1 and VjVj+1, and without loss of generality assume that } 21+1 as shown in Figure 44b. Since ViVi+1 
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is an opposite edge, Vi € OPL(Vi+1). Therefore OPL(Vi+1) C OPL(Vij) and OPL(Vi«1) C OPL(V;j41). By 
similar reasoning with respect to edge VjVj+1, OPL(Vj+1) E OPL(Vi) and OPL(Vj+1) COPL(Vi+1). But 


this is acontradiction, so there must be no more than one opposite edge. 


Therefore a convex polygonal obstacle has exactly one opposite edge. € 


LEMMA V-1.4: An opposite-edge boundary emanates from each obstacle opposite edge and consists of seg- 
ments of hyperbolas such that an initial hyperbola segment starts at the opposite point and is defined by con- 
sidering the vertices V1 and V2 of the opposite edge as its foci, with hyperbolic constant being the absolute 
value of the difference of the costs of (V1G)* and (V2G)*, as specified in Equation 1. If at any point a shadow 
boundary intersects the opposite-edge boundary, it will continue along a new hyperbola segment defined by 
considering as foci, first, the vertex of the edge which generated the shadow boundary and which is closer to 
the goal of the two vertices of that edge, and second, the focus of the previous hyperbola which is not also a 


vertex of the edge which generated the shadow. 


PROOF V-1.4: Given a convex polygonal obstacle O with opposite edge V1V2, and given point X on V1V2 
such that J(XG)i* and (XG)2*, (XG)1* # (XG)2*, i.e., X is the opposite point. Since V1 V2 is a hidden edge, 
then it must be that OPL1(X) = [V1 | OPL(V1)] and OPL2(X) = [V2 | OPL(V2)] (see Figure 45a). Consider 
point P arbitrarily close to X in the obstacle exterior. By Theorem I-2, (PV1)* =!PV)l and (PV2)* = IP Val, be- 
cause no other terrain features intervene, so P is in both the homogeneous-behavior region with V1 as root and 


the region with V2 as root. By Theorem V-0.1, the set of points P is described by Equation 1. 


Let B; be the set of points over which P obeys the Equation 1. As P moves away from X, it lies on B1 
only as long as PV1 C (PG)1* and PV2 C (PG)2*, i.e., as long as the line segment from P to both vertices are 
part of the respective optimal paths from P in the two directions. If at some point Z it becomes true that PVj 
C. (PG)i*, for 121 or 122, then at that point Bi must have intersected shadow boundary i (see Figure 45b). 
Now the same reasoning as above applies to the point Vx, where OPL(Vi) = [Vx | OPL(Vx)], and so another 
hyperbola branch B2 becomes the adjoining portion of the opposite-edge boundary. Since point Z lay on both 


hyperbola branches B; and B2 , it must be that Bi and B2 intersect at point Z. The same reasoning continues 
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to apply as long as Bj intersects any shadow boundary of obstacle O. Therefore the opposite-edge boundary 
is aconnected sequence of hyperbola segments starting at the opposite point, and for each segment consisting 
of a portion of the hyperbola branch with the two visible obstacle vertices as foci and the hyperbolic constant 


being c2-c1, wherec2>c1. @ 


THEOREM V:-1: Aconvex polygonal obstacle in homogeneous background terrain with specified goal-point 
will generate as boundaries the obstacle edges, shadow boundaries from each vertex of a hidden edge as 
specified in Lemma V-1.2, and a single opposite-edge boundary consisting of piecewise hyperbolic segments 


as specified in Lemma V-1.4. 
PROOF V-1: Theorem V-1 follows directly from Lemma V-1.1, Lemma V-1.2, and Lemma V-1.4. 
LEMMA V-2.1: A river segment, or river-edge, constitutes a boundary between regions. 


PROOF V-2.1: (See Figure 46a.) Given river segment V1 V2, and point X1 arbitrarily close to V1 V2 having 
optimal-path list OPL(X1) = [W | OPL(W)] where W € V1V2,1.e., X1’s optimal path does not cross the river, 
and point X2 arbitrarily close to V1 V2 on the opposite side V1 V2. Now X2 may have one of three possible op- 
timal-path lists: OPLa (X2 ) 2 [Vi | OPL(V1)] i.e., it goes around end 1 of the river, or OPLe(X2) 2 [V2 | 
OPL(V2)], i.e., it goes around end 2 of the river, or OPLe(X2) 2 [[V1V2] | OPL(W)] where [V1V2] specifies 
that the path crosses the river without changing direction, and W is the next point on the optimal-path list. 
Since in all three cases, the optimal-path list of X2 is different from that of X1 , therefore X1 and X2 are in 


different regions. Therefore the river edge constitutes a boundary. € 


LEMMA V-2.2: Each river vertex V with OPL(V) = [W | OPL(W)] which is an endpoint of a river segment 
not joining any others will generate a shadow boundary which is a ray lying on the line VW, starting at V and 


lying away from W. 
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PROOF V-2.2: Given the same situation as in Proof V-2.1, analyze OPLa (X2 ) = [Vi | OPL(V1)] and 
OPLb(X2) = [V2! OPL(V2)}, with respect to vertices Vi and V2 in the same manner as in Proof V-1.2 to show 
that there are rays emanating from V\ and V2 lying away from the goal which act as boundaries between op- 
timal paths which go around the vertices and those which bypass them. Note that, assuming a positive river- 
crossing cost, location c for X2 will never be such that X2 , Vi, and the next point in OPL,(Vi) are collinear, 
because if so, it will be less costly for the optimal path to avoid crossing the river and go around vertex Vj in- 


Stead. @ 


LEMMA V-2.3: A river segment with vertex V with OPL(V) = [W | OPL(W)} not adjoining any other river 
segment may have a river-crossing boundary which is a segment of one branch of a hyperbola constructed by 
considering as foci the points V and W, with hyperbolic constant c = |VWI - cr, where cr is the fixed river- 
crossing cost. This boundary will exist if the branch closer to V intersects the river segment. The boundary 
consists of the portion of the hyperbola branch between the intersection of the branch with the river, and the 


first point of intersection of the branch with another river boundary. 


PROOF V-2.3: Consider point P which lies in the shadow of river segment with vertex V as in Figure 46b, 
where ro is the cost rate for travel in the background region. As in Figure 46a, there are only three possible 
ways the optimal path from P can go initially. If P lies on a boundary between paths which cross the river 
paying the fixed crossing cost, and paths which go through V, the first region has V as its root and the second 
region has the river segment as its root. Optimal paths crossing river segments do not change headings. There- 
fore, the path from P to W has cost cpw = ro d(P,W) + cr. The cost of the path from P to V has cost cpv = ro 
d(P,V), as usual with a point root, and the cost cw from W is known. But this is just as if paths in region 2 had 
W as a root, where the cost from W to G was cw + cr. Thus, the boundary separates two regions whose roots 
are points, so by Theorem V-0.1, the boundary is a hyperbola segment described by Equation 1. If cr and the 


orientation of VW are such that the boundary does not intersect the river segment between V and U, it must 
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be that for all points in the shadow of the river segment, it is more costly to cross the river than to go around 


via V. 4 


LEMMA V-2.4: A river segment with vertices V1 and V2 has an opposite-edge boundary which lies on the 
hyperbola formed by considering each vertex as a focus conforming to Equation 1, and lies on the branch of 


the hyperbola which is closer to the vertex with higher-cost optimal path. 


PROOF V -2.4: Consider point Q in Figure 46b. This point is on the boundary which separates region | from 
region 3. Optimal path from Q through region 1 goes through V, while the optimal path through region 2 goes 


through U. Thus, the boundary separates regions whose roots are both points, so Theorem V-0.1 applies. + 


THEOREM V -2: An isolated river segment has a river-edge boundary, two shadow boundaries formed as 
specified in Lemma V-2.2, an opposite-edge boundary formed as specified in Lemma V-2.4, and either two, 


or no, river-crossing boundaries as specified in Lemma V-2,3, 


PROOF V-2: Consider points X1, X2, V1 and V2 as in Proof V-2.1 and Figure 46a, with optimal-path lists 
OPL(X1), OPL(Xa), OPL(Xpb), and OPL(X;) as described in Proof V-2.1. Clearly, these four optimal-path lists 
are the only ones possible for points arbitrarily close to an isolated river segment, so by the definition of a 
homogeneous-behavior region, there are no more than four regions associated with a river segment. Thus the 
only boundaries possible adjacent tc an isolated river segment are those between pairs of these four regions, 
plus a fifth, the region unaffected by the river. The form of each boundary follows directly from Lemmas V- 


2.1, V-22, V-2.3, and V-24. € 


LEMMA V-3.1:A road-edge forms a boundary between homogeneous- behavior regions. 


PROOF V-3.1: Trivially true. € 
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LEMMA V-3.2:Given road segment with goal G, one vertex V, and the other vertex’s location unspecified, 
and cost-rate rr, with cost-rate in the background ro. If the characteristic wedge V AGB as defined in Chapter 
V lies "inside" road- vertex V, two road-end/road-travelling boundaries will be formed as rays with vertex at 


V, each lying so that its angle with the road is 7/2 -- V. 


PROOF V-3.2:Consider the road segment of Figure 47a, with goal G, one vertex V, and the other vertex's 
location unspecified, and cost-rate rr, with cost-rate in the background ro. As shown in [Ref. 2], paths will enter 
leave a road interior only at the critical angle Y = sin ! (rro). Thus a path leaving the road to point G will do 
so at point A. If GA does not intersect the road at or to the "left" (in the figure) of V, no paths will travel along 
the road from the direction of V. Otherwise, V AGB is said tolie "outside" V, and paths travel along the road 
from V. Consider points P1 and P2 in the vicinity of P. If P is arbitrarily close to V, the path from Pı will enter 
the road at angle en route to A, while the path from P2 will enter the road at V. Thus, the set of boundary 
points P lies on ray VP such that ZPVA = 11/2 +. The same reasoning with respect to point Q gives that 


ray VQ also 1s a boundary. € 


LEMMA V-3.3:Given road segment with goal G, one vertex V, and the other vertex's location unspecified, 
and cost-rate rr, with cost-rate in the background ro. If the characteristic wedge V AGB lies "inside" road- 
vertex V, a road-end/goal boundary will exist on the V end of the road segment, forming a segment of a hy- 


perbola with V and G as foci and obeying Equation 1. 


PROOF V-3.3:Consider point P in Figure 47b, with OPL1(P) = [V, A, G], and OPL2(P) = [G]. Since the two 
regions through which the optimal paths from P lie have points as roots, Equation 1 applies, and the bound- 
ary is ahyperbola segment with V and G as foci. The boundary will begin at the point at which the hyperbola 


intersects the road- end/road-travelling boundary of Lemma V-3.2.¢ 


LEMMA V-3.4:Given road segment with goal G, vertices V1 and V2, and cost-rate r;, with cost-rate in the 
background ro. If the characteristic wedge VAGB lies "inside" road-vertex V1, a near-side-road-travell- 


ing/goal wil exist on the near side of the river which forms a parabola with focus G and directrix as specified 
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in Equation 2. The boundary will begin at the point of intersection of the parabola with the road segment, 


which will be at V2 if VAGB lies "outside" Va, and will be at A otherwise. 


PROOF V-3.4:From Figure 47c, the paths from P go to the road and travel along it, or go to the goal. Thus, 
the boundary is between regions with point root and road root, so Equation 2 applies. Since paths leave the 
road at W in Figure 37, point V2 will correspond to point W if the wedge is "outside" V2, or point A will cor- 


respond to point W otherwise. + 


LEMMA V-3.5:Given road segment and goal G. If VAGB is "inside" road vertex V, a road-travelling/roaa- 
crossing boundary will be formed on the far side of the river which is a ray with vertex at point A and col- 


linear with GA lying away from G. 


PROOF: V-3.5:1f V AGB is "inside" V, Figure 47d will apply. Paths from points P1 just to the "left" of P in 
the figure will cross the road directly to G, while the path from P and P2 enter the road and travel along it to 


A, where they exit to G. 4 


LEMMA V-3.6:Given a road segment with vertex V and goal G, with road cost-rate rr and background cost- 
rate ro. À far-side-road-travelling/goal boundary will exist if Vis outside V. The boundary will be a parabola 


which begins at V and lies away from the goal. 


PROOF V-3.6:From Figure 47f, the paths from P go to the road and travel along it, or go to the goal. Thus, 
the boundary is between regions with point root and road root, so Equation 2 applies. Since the point W in 


Figure 37 is the point at which paths leave the road, V will correspond to point W. + 


LEMMA V-3.7:If VAGB "straddles" V, a road shadow boundary will exist as a ray from V, collinear with 


GA, and lying away from G. 
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PROOF V-3.7:From Figure 47g, a path from P; will cross the road, while a path from P2 will bypass it. This 
will occur only if VAGB "straddles" V, because otherwise paths from P2 will enter the road and travel along 


itto A. 4 


THEOREM V-3:Given a road segment V1 V2 with cost-rate rr, a goal G, and a background cost-rate ro, if 
characteristic wedge V AGB is "inside" Vi, one road-end/road-travelling, two road-end, one near-side-road- 
travelling/goal, and one road- travelling/road-crossing boundaries exist on the Vj end of the road segment; 
when V AGB "straddles" Vi, a road shadow boundary exists on the Vj end; when VAGB is "outside" Vi, one 
near-side-road-travelling/goal and one far-side-road-travelling/goal boundaries exist on the Vj end; and the 
road segment is always a boundary. The form of these boundaries is as described in Lemmas V-3.1 through 


V-3.7. 


PROOF V-3:Follows directly from Lemmas V-3.1 through V-3.7. 


LEMMA V-4.1:Given high-cost, exterior-goal HCA with two visible edges V; V2 and V3 V4, if the two regions 
whose paths cross the two edges are adjacent, the visible-edge boundary between them is described by Equa- 


tion Set 4. 


PROOF V-4.1:Per Figure 48a, the edges Vi V2 and V3V4 are roots of region 1 and region 2 respectively. Paths 
which cross them go directly to G, ard so the description of Theorem V-0.4 applies to this situation, and Equa- 


tion Set 4 describes the boundary. # 


LEMMA V-4.2:Given high-cost, extcrior-goal HCA with a visible edge V1 V2 and a hidden edge V3V4, if the 
region whose paths cross edge V1 V2 and the region whose paths go to and travel along edge V3V4 are ad- 


jacent, the visible-hidden-edge boundary between them is described by Equation Set 5. 


PROOF V-4.2:Per Figure 48a, the edges Vi V2 and VsVearc roots of region 1 and region 3 respectively. Paths 


which cross edge V1V2 obcy Snell's Law, and then go directly to G, while those which travel along edge VsV6 
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leave the edge at point Vs en route to the goal and so the description of Theorem V-0.5 applies to this situa- 


tion, and Equation Set 5 describes the boundary. 


LEMMA V-4.3:Given high-cost, exterior-goal HCA with two hidden edges V4Vs and V6V7, such that 
OPL(Pe) = [Vs, V4 | OPL(P4)], if the two regions whose paths enter and travel along the two edges are ad- 


jacent, the hidden-edge-mer ging-path boundary between them is described by Equation Set 3. + 


PROOF V-4.3:Per Figure 48c, the edges V4Vs and V6V7 are roots of region 4 and region 5 respectively. Paths 
which enter edge V4Vs at the critical angle travel along it and leave at V4 en route to the goal, while those 
which travel along edge V6V7 leave the edge at point Ve, eventually merging with paths from region 4. So the 
two edges are linearly- traversed edges and are the roots of regions 4 and 5, so the description of Theorem V- 


0.3 applies to this situation, and the boundary is a line segment as described therein. $ 


LEMMA V-4.4:Given high-cost, exterior-goal HCA with two hidden edges V4Vs and VeV7, such that 
OPL(Pe) = [Vs, V4! OPL(P4)], 1f the two regions whose paths enter and travel along the two edges are ad- 
jacent, the hidden-edge-diverging-path boundary between them is a line segment described by Theorem V- 
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PROOF V-4.4:Per Figure 48e, the edges V4Vs5 and V7Vgare roots of region 4 and region 6 respectively. Paths 
which enter edge V4Vs at the critical angle travel along it and leave at V4 en route to the goal, while those 
which travel along edge V7Vg leave the edge at point Vg (going in the other direction around the exterior of 
the HCA). So the two edges are lincarly- traversed edges and are the roots of regions 4 and 6, so the bound- 


ary between them is a line segment as described in Theorem V-0.3. 4 


LEMMA V-4.5:Given a high-cost HCA with exterior goal G and vertices Vi. There is a boundary associated 
with each Vi such that optimal paths in one region cross edge Vi.1Vi and optimal paths in the other region 
cross edge ViVi«1, except in the case that shorcutting occurs along the entire edge ViVi+1 to edge Vi.1Vi, in 


which case no boundary occurs for vertex Vj. 


PROOF V-4.6:There are three cases: both edges are visible, one edge is visible and the other is hidden, or 
both edges are hidden. When both edges are visible, by definition optimal paths from neither vertex includes 
points along an edge of the HCA. Consider Figure 30, and points near V2 in the HCA interior. Since the inte- 
rior has higher cost-rate than the exterior, there is no incentive for paths from points close to the visible edge 
to move further away from it. Rather, such paths will cross the edge as soon as possible to use the lower-rate 
exterior. Thus there are some points in the interior close to Vi whose paths cross edge Vi-1 Vi and some whose 
paths cross edge ViVi+1. There is, therefore, a boundary between them which begins at Vi and lies in the HCA 
interior. 

In the second case, by the same reasoning as above, some paths whose start points are close to Vj will 
cross visible edge Vi-1 Vi. But some points close to Vi may be far enough from edge Vj-1 Vi that it will be less 
costly to move initially away from the goal to edge ViVi+1 in order to travel at the less expensive exterior rate. 
Clearly, this will cause a boundary which begins at Vi. If, however, edge ViVi+1 forms an acute enough angle 
with Vj-1 Vj that there are no points near Vj for which it will be less costly to move away from the goal. In this 
situation, shortcutting will occur, at leastin the vicinity of Vi. If some paths travel along edge ViVi+1, the point 
at which they shortcut into the interior will be the beginning of the boundary associated with Vi, because points 
just inside ViVi+1 and toward Vi+1 from the shortcuttuung point will have less costly paths by moving away 
from the goal to the lower-rate edge, while points just inside but toward Vj from the shortcutting point will go 
directly across the HCA. If shortcutting occurs all along edge ViVi+1, however, there will be no boundary as- 
sociated with Vi, because all paths have the same behavior. In the third case, by the same reasoning as above, 
a vertex joining two hidden edges will have an associated boundary unless shortcutting occurs all along the 


edge. 


LEMMA V:-4.7: The edges of a high-cost HCA with exterior goal are homogeneous-behavior boundaries. 


PROOF V-4.7:Trivially true. € 
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LEMMA V-4.8:Given a high-cost HCA with exterior goal G, each vertex V of a hidden edge generates a 
linear shadow boundary which is the ray lying on the line defined by V and the first point P on OPL(V), start- 


ing at V and lying in the opposite direction from P. 


PROOF V 4.8: The proof is the same as for Lemma V-1.2. (See Figures 23, 24, and 25.) € 


LEMMA V-4.9:Given a high-cost HCA with exterior goal G with n interior boundary trees. There exists an 
opposite-edge boundary associated with each tree which begins at the point at which an interior boundary of 
the tree not associated with a vertex (i.e., not one of the leaf nodes of the tree, see Figures 30, 31, and 32) in- 
tersects an edge of the HCA. There is also an opposite-edge boundary which begins at each point at which two 
other opposite- edge, or a shadow and an opposite-edge boundary intersect. An opposite-edge boundary is 
described by Equation 1 if the interior boundary at which it begins separates regions of two linearly-traversed 
edges, or by Equation Set 6 if the interior boundary at which it begins separates regions whose paths cross two 
edges en route to the goal. If it begins at the intersection of two other exterior boundaries, it will be described 
by Equation 1 if the two regions which the intersecting boundaries do not have in common have point roots, 
and by Equation Set 6 (or a degenerate version) if one of the regions which the intersecting boundaries do not 


have in common has paths which cross two edges en route to the goal. 


PROOF V-4.9:At the point at which an interior-boundary tree intersects a hidden edge of the HCA other than 
a vertex, one of four situations must exist. An optimal path from the point of intersection may go across the 
HCA interior and a second optimal path from the same point travels along the hidden edge, for example, in 
Figure 30 where two of the boundaries labelled "b” intersect edge V4Vs. Secondly, one path from the point of 
intersection may cross a visible edge and a second path cross another edge, as in the boundary labelled "a" in 
Figure 30. Third, two paths may go from the point of intersection in opposite directions along the edge, as in 
the boundary labelled "d" in Figure 31, where one path goes through V4 and one path goes through V3. Fourth- 
ly, there may be only one optimal path from the point of intersection, as in the boundary in Figure 31 that in- 


tersects edge V2V3. 


By examining Figures 30 and 31, it can be seen that when there are two optimal paths from the point of 
intersection of the interior boundary, there are points in the HCA exterior which also go in two directions, 
forming a boundary. In the fourth case above, where there is only one optimal path from the point of intersec- 
tion, it can be seen that there is no exterior boundary. But the interior boundary in this case is associated with 
a verte x. In the first case, the exterior boundary separates a region whose points go to the vertex of the hid- 
den edge through which goes the path from the intersection point, from the region whose paths cross two edges 
en route to the goal. This is a degenerate case of Theorem V-0.6, where one path crosses two edges and the 
other path goes through a point instead of crossing two edges, so Equation Set 6 applies. In the second case, 
the exterior boundary separates a region whose paths cross two edges from a region whose paths cross two 
other edges, so Equation Set 6 applies. In the third case, the exterior boundary separates two regions whose 


paths go through points, as in Theorem V-0.1 and Equation 1. 


When any two exterior boundaries intersect, it must be that a third opposite-edge boundary begins, be- 
cause past the point of intersection there must be a discrimination between the two regions which the first two 
boundaries did not have in common. The third boundary has as its region roots either two points, a point for 
one root and two edges for the other, or two different edges for both roots, because these are the only types of 
roots which the original exterior opposite-edge boundaries had. These roots are described by Equation 1 or 
Equation Set 6, where a degenerate case of Equation Set 6 is the case that one of the pair of edges is replaced 


by a vertex. Figures 30 and 31 show examples of exterior boundaries intersecting. 9 


LEMMA V-4.10:Given high-cost HCA with exterior goal G, and vertex V joining a visible and a hidden edge 
across which shortcutting occurs. There is a corner-cutting boundary which begins at point V and obeys the 
degenerate form of Equation Set 6 where paths on one side of the boundary cross two edges, while paths on 


the other side go through a vertex. 


PROOF V-4.10:(See Figure 31.) Points on the shadow boundary emanating from V2 in Figure 31 (labelled 
“e’) go through V2 to the goal. Since the HCA interior has a higher cost-rate than the exterior, there are some 


points just below the shadow boundary which will travel to V2 rather than go through the HCA. But points 
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further below the shadow boundary will have further to go to vertex V2 and so will cross the HCA, paying the 
higher cost-rate to do so. One set of points lies in a region with V2 as root, while the other set of points lies in 
a region with edge V2V3 as root. Paths in the second region cross two edges en route to the goal. This con- 


forms to the degenerate form of Equation Set 6. + 


THEOREM V-4:A high-cost HCA with exterior goal has boundaries according to Lemmas V4.1 through 


V-4.10. 
PROOF V-4:Follows directly from Lemmas V-4.1 through V-4.10. @ 


LEMMA V-5.1:Given high-cost HCA with interior goal G. If the optimal path from a vertex Vi travels ini- 
tially along an edge of the HCA, there is a hidden-edge boundary which begins at Vi and is a line segment 


conforming to Theorem V-0.3. 


PROOF V-5.1:(See Figure 33.) Assume that for a vertex of high-cost interior-goal HCA Vi, OPL(V1) 2 [X, 
G], where X is a point on HCA edge ViVi-1, for example V3 in Figure 33. Then there will be some points close 
to Viin the HCA intenor which will exit and travel along edge ViVi-1 to X. Similarly, there will be some points 
close to Vi on edge Vi+1 Vi whose paths go through Vi, and so there will be points close to Vi in the HCA in- 
terior which exit the HCA and travel along edge Vi+1 Vi to Vi. Thus there are two regions in the vicinity of Vi, 
and the boundary between them separates paths which enter a linearly-traversed edge and travel along it from 
those which enter another linearly-traversed edge and travel along it. This is the situation of Theorem V-0.3, 


so the boundary is a line segment as described therein. € 


LEMMA V-S.2:Given high-cost HCA with interior goal G. If the optimal path from a vertex Vi travels ini- 
tially along an edge of the HCA, there is a hidden-edge/goal boundary which is a parabola as specified in 
Equation 2 which separates points which go to and travel along edge ViVi«1 from points which go to and travel 


along edge ViVi.1. 
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PROOF V-5.2:(See Figure 33, boundaries labelled "b".) By the same reasoning as Lemma V-S.1, there are 
points close to vertex Vi which exit the region and travel along edge Vi+1 Vi to Vi. Consider point P which is 
moved away from Vi into the interior along the hidden-edge boundary associated with Vi. At some point, paths 
from P which go to edge ViVi+1 will cost no less than a path from P straight to the goal at the higher cost rate. 
At this point, a new boundary begins separating points which go to edge ViVi+1 and travel along it to Vi, from 
points which go to G. This is the same situation as described in Theorem V-0.2, with Equation 2 describing 


the parabolic boundary. ¢ 


LEMMA V-5.3:Given high-cost HCA with interior goal G. If the optimal path from a vertex Vj travels ini- 
tially along edge ViVi-1 of the HCA and cuts into the HCA at some point along edge ViVi-1, there is a visible- 
edge/goal boundary which is a parabola as specified in Equation 2 and separates points which travel along the 


visible edge ViVi-1 from those which go directly to the goal. 


PROOF V-5.3:By the same reasoning as Lemma V-5.2, when point P is far enough from Vj that paths which 
go to edge ViVi.1 cost no less than a path that goes directly to G at the higher cost rate, a boundary will begin 
separating points which go to the linearly-traversed edge from those which go to the point G. This is the same 


situation as described in Theorem V -0.2, with parabola as described in Equation 2. + 


LEMMA V-5.4:Given high-cost HCA with interior goal G, and two adjacent vertices Vj and Vi+1 which have 
opumal paths lying on HCA edges, neither of which is edge ViVi+1. Then there will be an interior-opposite- 


edge boundary whichisa line segment beginning on edge ViVi+1 and conforming to the description of Theorem 


V-0.3. 


PROOF V-5.4:If the optimal path from Vj lies initially on edge ViVi-1, and the optimal path from Vi+1 lies 
initially on edge ViVi«1, as must be by assumption, there will be points in the interior of the HCA as described 
in Theorem V-0.3 which have paths which go to edge ViVi+1 and travel along it to Vi, and similarly there will 
be points in the interior which have paths which go to edge ViVi+1 and travel along it to Vi+1. Where these 


two regions meet, the boundary will separate points whose paths go to one linearly-traversed edge from points 
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whose paths go to another linearly- traversed edge, the situation described in Theorem V-0.3. Therefore, the 


boundary will be a line segment as described in Theorem V-0.3. 


LEMMA V-5.5:Each edge of a high-cost HCA with interior goal will be a hca-edge boundary. 


PROOF V-5.5:Trivially true. 4 


LEMMA V-5.6:Given high-cost HCA with interior goal G. If the optimal path from a vertex Vi travels ini- 
tially along an edge of the HCA with OPL(Vi) = [X | OPL(X)], there is a shadow boundary which is a ray with 


vertex Vj and collinear with line ViX, which lies away from X. 


PROOF V-5.6:The proof proceeds as in Proof V-1.2. 4 


LEMMA V-5.7:Given a high-cost HCA with interior goal G, and opposite edge ViVi«1 as defined in Lemma 


V-5.4. Then an exterior opposite-edge boundary exists which conforms to Equation 1. 


PROOF V-5.7:At the point at which the interior-opposite-edge boundary intersects edge ViVi+1, there are 
two optimal paths which go through vertices Vj and Vi+1. Points will exist in the exterior, but close to this in- 
tersection point, which will have optimal paths which go through these vertices as well. These points are on a 
boundary which separates points whose paths go through Vj from those which go through Vi+1, two regions 
with point roots. Therefore, Theorem V-0.1 applies, and the boundary is a hyperbola segment which conforms 


to Equation 1. # 
LEMMA V-5.8: Given high-cost HCA with interior goal G, and vertex Vi which has optimal path which goes 
directly to G. There will be a visible-edge boundary in the HCA exterior beginning at Vj which conforms to 


Equation Set 4. 


PROOF V-5.8:Consider points close to Vj outside the HCA. Since the best path from Vj is straight to the goal, 


clearly paths from points in the lower-cost exterior will have optimal paths which go directly to the goal via 


1923 


a Snell’s-Law path across one of the edges incident upon Vi. The boundary which separates paths which cross 
one edge from those which cross the other edge conform to the situation described in Theorem V-0.4, and so 


the boundary will conform to Equation Set 4. € 


LEMMA V-5.9:Given a high-cost HCA with interior goal G and vertex Vi with associated hidden-edge/goal 
boundary which intersects edge ViVi+1. Then there will be a corner-cutting boundary which begins at the point 
of intersection and continues into the exterior conforming to a degenerate form of Equation Set 4, where one 


edge-crossing degenerates to a point crossing. 


PROOF V-5.9:(See Figure 33, bouudaries labelled "h".) At the point of intersection of the hidden-edge/goal 
boundary with edge ViVi+1, there are two optimal paths; one goes directly to the goal, and the other goes 
through Vj. A point just outside the HCA in the vicinity of the point of intersection may therefore have a path 
which goes to Vi, or which crosses edge ViVi+1 en route to the goal. The boundary separating such points is 
therefore a boundary between a region which has a point as root, and one which has an edge-crossing as root. 


This is a degenerate form of the situation of Theorem V-0.4, so Equation Set 4 applies. @ 


THEOREM V-S5: Given a high-cost HCA with interior goal, the boundaries associated with the HCA are as 


described by Lemmas V-5.1 through V-5.9. 


PROOF V-5: (See Figure 33.) Follows directly from Lemmas V-5.1 through V-5.9.4@ 


LEMMA V-6.1:Given a low-cost HCA with interior goal point G, there are no boundaries in the HCA inte- 


rior. 


PROOF V-6.1: (See Figure 34.) Assume that there is a point P with optimal path OPL(P) = [R | OPL(R)], 1.e., 
that the path does not go directly to the goal. R must lie on an edge or vertex, by Theorem I-2. In either case, 
the path must be longer in Euclidean distance than the line segment PG, by the triangle inequality. Since the 


interior cost-rate 1s lower than the exterior cost-rate, there is no advantage to a path to use the exterior cost- 
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rate, so the cost of PG must be less than IPRI + I(RG)*l, which is a contradiction. Therefore all interior points 
have the path list [G]. By the definition of a homogeneous-behavior region, the entire HCA interior is a single 


region, so there are no interior boundaries. 


LEMMA V-6.2: Given a low-cost HCA with interior goal G. From each vertex V there are two vertex/edge- 
crossing boundaries separating points whose optimal paths go through V and then to G from those which cross 
an edge obeying Snell's-Law and then go to G. Each boundary lies on the the path from G through V which 


obeys Snell's Law for crossing one of the edges incident upon V. 


PROOF V-6.2:(See Figure 34.) Consider a point P in the HCA exterior arbitrarily close to the exterior leg of 
a Snell’s-Law path from G through V with respect to edge E. The optimal path from P goes through edge E 
obeying Snell’s Law. By the principle of opumality (Theorem I-1), all points along that path also have optimal 


paths which lie on the same path. Thus, the boundary is a ray lying at the angle prescribed by Snell's Law. € 


THEOREM V-6:Given a low-cost HCA with interior goal. The interior has no boundaries, and the exterior 


boundaries are as described in Lemma V-6.1. 


PROOF V-6:Follows directly from Lemmas V-6.1 and V-6.2. 4 


LEMMA V-7.1:Given a low-cost HCQ with exterior goal, each edge is an hca-edge boundary. 


PROOF V-7.1:Trivially truc. 4 


LEMMA V-7.2:Given low-cost HCA with exterior goal G and vertex V such that the optimal path from V 
goes initially into the HCA interior. Then a vertex/edge-crossing boundary exists for each edge incident upon 
V which is the second leg of a path from G through V which obeys Snell's Law with respect to the edge, and 
separates paths starting in the exterior which go through V from paths which cross the edge. If the optimal 
path from V goes initially along an edge of the HCA, one such boundary exists with respect to the edge inci- 


dent upon V not travelled by the path from V. 
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PROOF V-7.2: (See Figure 35.) The same reasoning as in Proof V-6.2 applies here. 4 


LEMMA V-7.3:Given low-cost HCQ with exterior goal G, interior cost-rate ri, exterior cost-rate re, and ver- 
tex V such that the optimal path from V goes initially along an edge of the HCA incident upon V. Then a ver- 
texledge-following boundary exists which is a ray from V along a line which makes the angle 1/2 + Oc with 


the edge, where 0. = sin”? (ri/re). 


PROOF V-7.3: (See Figure 35.) The analysis is the same as Proof V-6.2 above. 4 


LEMMA V-7.4:Given low-cost HCA with exterior goal G, and vertex V with optimal path which goes ini- 
tially along an edge of the HCA. There is a parabolic edge-following/goal boundary which begins along the 
edge, conforms to Equation 2, and separates paths which go to the edge and follow it, from paths which go 


directly to the goal. 


PROOF V-7.4: (See Figure 35.) The proof is the same as for the near-side-road- travelling/goal boundary for 


road segments in Proof V-3.4. 


LEMMA V-7.5:Given low-cost HCA with exterior goal G, and vertex V such that the optimal path from V 
lies along an edge of the HCA incident upon V. Then there is a hyperbolic vertex/goal boundary which con- 


forms to Equation 1, and separates paths which go through V from those which go directly to G. 


PROOF V-7.5: (See Figure 35.) The proof is the same as for road-end/goal boundary of road segments, Proof 


V-3.3.4 
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LEMMA V-7.6:Given a low-cost HCA with exterior goal and vertex Vi such that the optimal path from Vi 
lies in the HCA interior, and vertex Vi. adjacent to Vi and closer to G. A edge-crossing/goal will exist if the 
vertex/goal boundary associated Vj-1 intersects the both vertex/edge-following boundaries emanating from Vi- 
1. It will conform to a degenerate form of Equation Set 6, and separate paths which cross edge ViVi.1 and then 


cross a visible edge en route to the goal, from paths which go straight to the goal. 


PROOF V-7.6: (See Figure 35.) At the point at which the hyperbolic vertex/goal boundary intersects the ver- 
tex/edge-following boundary associated with edge ViVi.1, the two regions not common to the boundaries are 
the one whose paths go straight to the goal, and the one whose paths cross the edge en route to a second edge 
crossing, and the goal. But this is the form of Theorem V-0.6, where one pair of edge-crossings degenerates 


to a single point- crossing. Thus Equation Set 6 applies. 


LEMMA V-7.7:Given low-cost HCA with exterior goal G, and vertex V with optimal path which goes direct- 
ly to the goal, such that V is not incident to any other homogeneous-behavior-region boundaries. There is a 


visible- edge boundary in the HCA interior which begins at V and continues across the HCA to a hidden edge. 


PROOF V-7.7:Consider points inside the HCA near V. The path from such a point crosses one edge incident 
upon V or the other (See Figure 35). Therefore, there are two regions inside the HCA, and the boundary 
separates the two. Since the region roots are both edges crossed by paths, Theorem V-0.4 applies, so the bound- 


ary conforms to Equation Set 4. @ 


LEMMA V-7.8:Given low-cost HCA with exterior goal G, and vertex V with optimal path which goes direct- 
ly to the goal, such that V is not incident to any other homogeneous-behavior-region boundaries, and given 
the visible- edge boundary in the HCA interior as specified in Lemma V-7.7. There is an opposite-edge bound- 
ary in the HCA exterior which begins at the point of intersection of the visible-edge boundary with the hidden 


edge and conforms to Equation Set 6. 
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PROOF V -7.8:At the point of intersection of the visible-edge boundary with the hidden edge, there are two 
optimal paths, which cross the two edges incident upon V. Points in the HCA exterior near this point of inter- 
section will cross into the HCA interior, crossing on one side or the other of the point of intersection. Points 
which cross on one side will traverse the HCA interior and cross one of the edges incident upon V, while points 
which cross on the other side will cross the other edge incident upon V. Therefore, the boundary which separates 


points with these two behaviors conforms to Equation Set 6. 


THEOREM V-7:Given a low-cost HCA with exterior goal, boundaries are generated according to Lemmas 


V-7.1 through V-7.8. 


PROOF V-7:Follows directly from Lemmas V-7.1 through V-7.8. + 
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APPENDIX B - POINT-TO-POINT WAVEFRONT PROPAGATION 


ALGORITHM 
algorithm wavefront-propagation (Algorithm B-1) 
input: Start-Point, Goal-Point 
{ 
Wavefront := Start-Point; 
while (Status = INPROGRESS) /* iteratively expand wavefront until */ 
expand-wavefront(Wavefront); /* status is DONE or NIL */ 


if (Status = DONE) 
Optimal-Path := Goal-Point concatenated 
with back-path(Goal-Point); 


else /* status 1s NIL, so no feasible solution */ 
Optimal-Path is undefined; 


} /* end of wavefront-propagation */ 


procedure expand-wavefront 
input: Wavefront 


{ 


if (Wavefront is empty) /* Base case of recursion. If empty at 1st call */ 
Status := NIL; /* to expand-wavefront, there is no feasible path */ 
else 


Current-Cell := cell on Wavefront with min remaining cost; 

expand-cell(Current-Cell); 

if not (Status = DONE) 
{ 
Rest-of-Wavefront := Wavefront less Current-Cell; 
expand-wavefront(Rest-of-Wavefront); /* recursive call to expand-wavefront */ 
if not (Status = DONE) 


| 


Wavefront := Cells-for-New-Wavefront /* Note: Wavefront is recursively emptied */ 
appended onto front of Wavefront; /* out level by level and new Wavefront */ 
Status := INPROGRESS; /* is built up as each level returns. */ 
| 
| 
| 
} /* end of expand-wavefront */ 
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procedure expand-cell 


input: Current Cell 


{ 
Finished-With-Cell := TRUE; 
Cells-for-New-Wavefront := empty list; 


/* initialize flag to assume that Current-Cell */ 
/* will not stay on Wavefront */ 


for (New-Cell := North-, East-, South-, and West-Neighbor) 


orthogonal-expand(Current-Cell,New-Cell); 


for (New-Cell := Northeast-, Southeast-, Southwest-, and Northwest-Neighbor) 


diagonal-expand(Current-Cell,New-Cell); 
if not (Finished-With-Cell) 


Cells-for-New-Wavefront := Current-Cell appended 


onto Cells-for-New-Wavefront; 
if (Cells-for-New-Wavefront contains Goal-Point) 
Status := DONE; 
else 
Status := INPROGRESS; 
} 


procedure orthogonal-expand 


*/ 


input: Current-Cell, New-Cell 


if ((Parent-Pointer-of-New-Cell is not yet set) 
or (Parent-Pointer-of-New-Cell 2 Current-Cell) 
or ((Initial-Cost-of-New-Cell - 1.414) 
< Cost-of-New-Cell)) 
{ 
Parent-Pointer-of-New-Cell := Current-Cell; 
Cost-of-New-Cell := Cost-of-New-Cell - 1.414; 
if (Cost-of-New-Cell < 0) 
{ 
overflow(Current-Cell, New-Cell); 
Cells-for-New-Wavefront := Overflow-List 
appended onto New-Cell; 
} 


else 


Cells-for-New-Wavefront := empty list; 
Finished-With-Cell :z FALSE; 
) 
) 
| 
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/* keep Current-Cell on Wavefront */ 


/* end of expand-cell */ 


/* if this 1s first cell to expand into New- */ 
/* Cell, or this path costs less to expand into */ 
/* New-Cell, set backpointer and explore New-Cell. 


/* Current-Cell becomes parent of New-Cell. */ 
/* decrement cost of New-Cell */ 


/* if New-Cell has been fully explored, */ 
/* then New-Cell and possibly an overflow */ 
/* cell are added to new Wavefront */ 


/* if New-Cell has not been fully explored, */ 
/* New-Cell is not added to new Wavefront */ 
/* but reset the flag to note that */ 

/* Current-Cell must stay on Wavefront */ 


/* end of orthogonal-expand */ 


procedure diagonal-expand 
input: Current-Cell, New-Cell 


if ((Parent-Pointer-of-New-Cell is not yet set) /* if this is first cell to expand into New- */ 
or (Parent-Pointer-of-New-Cell 2 Current-Cell) /* Cell, or this path costs less to expand into */ 
*/  or((Initial-Cost-of-New-Cell - 1.0) /* New-Cell, setbackpointer and explore New-Cell. 
« Cost-of-New-Cell)) 
{ 
Parent-Pointer-of-New-Cell := Current-Cell; /* Current-Cell becomes parent of New-Cell. */ 
Cost-of-New-Cell := Cost-of-New-Cell - 1.0; /* decrement cost of New-Cell. */ 
if (Cost-of-New-Cell < 0) /* if New-Cell is fully explored, */ 
Cells-for-New-Wavefront := Cells-for-New- /* add it to new Wavefront. */ 
Wavefront appended onto New-Cell; 
else 
/* if New-Cell is not fully explored,*/ 
Cells-for-New-Wavefront := null list; /* do not add it to new Wavefront */ 
Finished-With-Cell := FALSE; /* and reset flag to insure that Current-Cell */ 
} /* gets put back on Wavefront. */ 
} 
} /* end of diagonal-expand */ 


procedure overflow 
input: Current-Cell, New-Cell 


Overflow-Cell := cell on opposite side of New-Cell from Current-Cell; 
if ((Parent-Pointer of Overflow-Cell is not yet set) 
or (Parent-Pointer of Overflow-Cell = New-Cell) 
or ((Initial-Cost-of-New-Cell - 1.0) 
« Cost-of-New-Cell)) 
{ 


Parent-Pointer of Overflow-Cell := New-Cell; /* Current-Cell becomes parent of New-Cell. */ 

Cost of Overflow-Cell := Cost of /* decrement Overflow-Cell by the negative */ 
Overflow-Cell + (Cost of New-Cell); /* amount left over from New-Cell. */ 

if (Cost of Overflow-Cell < 0) /* if necessary, call overflow again. */ 


{ 

overflow(New-Cell, Overflow-Cell); 

Overflow-List := Overflow-List 
appended onto Overflow-Cell; 


else /* else Overflow-Cell is not */ 
Overflow-List := empty list; /* added to new Wavefront. */ 
else /* if Overflow-Cell already has */ 
Overflow-List := empty list; /* a parent, do nothing. */ 
} /* end of overflow */ 
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APPENDIX C - WAVEFRONT-PROPAGATION OPM CONSTRUCTION 
SOURCE CODE 


e RARARAAARAARA RARA AA AAA AAA ARA AAA ARCA AA RA AAA AAA AAA AAA AAA AAA AAA AAA AAA OR A 
' 


e OA OX OO Xx X Xx Àx € x 00x A 0 x Ax Fx X x Ax A Ax Ax Àx& Ax Ax A A 0 Án Ax An Fn à A 0I x0 III I I kk kx kk 
r 


D***** "opm" creates an optimal path map by finding the boundaries 
D***** between regions of similarly-behaved optimal paths using the 
;***** wavefront propogation algorithm. The basic structure of the 
;*****K wavefront algorithm used is adapted from a Prolog program 

D**^^** hy MAJ Bob Riehbourg, Juneri 

¿RARA This is the "pure" version which tests for boundaries by checking 


we "o "e 


RAFA for the equivalent turn-points in the optimal-path list of 


tinak, neighboring ce kls: 
* &**kxk 


:***** Current as of 27 Jun 89 
AAA 


D***** Input: files "declar",; "3natmap' “utils”, bdr Par pim UN 
;****4 Output: Graphical output to the host Symbolics screen. 


RRRAAAA AAA AAA A AAA AAA AAA AAA KARA AAA AA AAA AAA AA AAA AAA RARA AAA] AA AA 


gU C ARA RRA A RARA RRA AR AAA RARA RRA RAR RAR RAR ARA RARA RRA RARA ARA RA RRA AAA AA A 


IRE RARA RARA RRA RARA AAA RARA RARE RARARA RAR RAA RARA AAA ARA REA RA KO CKOR OK UK ROR KK E 


;***** Function "opm" 1s the top-level function ot treo inan 


SUE KUNDEN Arguments: none 

fs Returned: T. ~ 

AN Side Effects: sets *boundary* array with the pixela which 
NN represent region boundaries. 

A Functions Used: initialize-map, initialize-graphics, 
SARARAR expand-wavefront, draw-and-show-windows, 

pranks draw-and-show-bdry-window, kill-windows, 

Sa eae and report-completion. 


(defun opm () 


(setf *internal-timel* (get~internal-run-t ime) ) 
(setf *external-timel* (get-universal-time) ) 
(initialize) 
(princ "Init Process Time: ") 
(prinl (- (setf *internal-time2* (get-internal-run-time)) internal Cime ros 
(linefeed) 
(Dp bane a: Elapsed Time: ") 
(prinl (- (setf *external-time2* (get-universal-time)) *external-timel*)) 
(linefeed) 
(do ((Wavefront (list *goal*) 

(expand-wavefront Havefront))) 

((null Wavefront))) 
(draw-and-show-window)) 

(cond ((equal nil *incremental-bdry-check*) (check-all-boundaries))) 
(princ " Expansion Frocess Time: ") 
(prinl (- (setf *internal-timel* (get-internal-run-time)) *internal-time EE 
(linefeed) 
(primos Elapsed Time: ") 
(prinl (- (setf *external-timel^ (get-universal-time)) *external-time2*)) 
(linefeed) 
(draw-and-show-bdry-window) 
(cond ((null *incremental-bdry-check*) (show-backpaths))) 
(report-completion)) 


SRRHER HEA KAAKRAKKHHERKHRKKRA RRR RRA KES WK WH RAK A OR WR ROR Re CR Re Ree ee eee 


ke o o o o 
? 


wt kk AK 
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Function initialize loads files, preprocesses the map, and 
initializes the graphics screen. 


(defun initialize () 


(load “declar”) 
(load “initmap") 
(load Mutis") 
(load "bdry") 
(load "graphics") 
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(initialize-map) 
(initialize-graphics) 
(princ “Beginning Wavefront Expansion") (linefeed) (linefeed) ) 


EUR ARK A RRR AR ARR AK REAR efe OA AO e e AUN AUN 0 


Loa *e e Fe "oe Ws veo » 


¡ARARA Function expand-wavefront: computes the next wavefront by taking 


A? the first pair of cell coordinates from the wave 

SAN and processing it, then recursively processing 

U^ the rest of the list in the same manner. 

ON Argument: Wave, the remainder of the old wavefront left to process 
ERA Returned: the new wavefront, or nil if Wave becomes empty 

ds Side Effects: see below 

AA Functions Used: expand-cell and expand-wavefront 


(defun expand-wavefront (Wave) 


(cond ((null Wave) nil) 
(t (append (expand-cell (car Wave)) 
(expand-wavefront (cdr Wave)))))) 


EA AAA RARRARA RR RRARARA RA RRARA RARA RARA RAR RARA RARA RARA RA RRA RARA RA RARA RARA 


;**x*** Function expand-cell: determines which of the eight neighboring 


ARA cells will be on the new wavefront and whether there is a 
ARAARA region boundary around the center cell. 

sak AAH Argument: Cell, a list of the X,Y coords of the cell on 

EINEN the current wavefront being processed. 

eue Returned: A list of cells to be added to the new wavefront 
ao Side Effects: none 

¿RRA Functions Used: orthog-expand, diag-expand 


oka KA 
, 


(defun expand-cell (Cell) 


(setq *finished-with-cell-p* 't) ; initialize flag - assume 
; cell will not stay on wf 
(cond ((not (null *incremental-bdry-check*)) (check-for-boundaries Cell))) 
(let* ((X (car Cell)) 
(Y (cadr Cell)) 
(Cells-to-add 
(nreverse 
(remove nil 
(append 
(orthog-expand (list X (14 Y)) (list ) 
(orthog-expand (list (1+ X) Y) (list ) 
(orthog-expand (list X (1- Y)) (list ) 
(orthog-expand (list (1- X) Y) (list ) 
iag expand {list (1- X) (1+ Y)) (list X Y)) 
(diag-expand {list (1t X) (1+ Y)) (list X Y)) 
X 
X 


x x KX 
M "X FA OF 


(diag expand (list (1+ X) (1- Y)) (list Y)) 
(diag-expand (list (1- X) (1- Y)) (list Y))))))) 
(cond 
umi Iinrshed-with-cell-p*) 
(cons (list X Y) Cells-to-add)) 
(t Cells-to-add)))) 


If some neighbors are not fully 
explored, leave center cell on wf 


er AA ere KE AA E KAA ARRAEAAKAAKAAKRARARAKARAKA AHA KAAKKKKAAHARKAHEHAEAERER * 


;***** Function diag-expand: explores a cell which is in a diagonal 


AA direction from the cell being expanded. 

RARA Arguments: same as orthog-expand 

M A^ Returned: A list consisting of a list of cells to be added to 

e A the new wavefront and a flag to note that (1) Center-cell 
¿ARARA has fully explored its neighbor, or (0) it has not. 

A Side Effects: Sets the parent coords of New-cell if they are nil 


(defun diag-expand (Hew-cell Center-cell) 


(let ((Xn (car New-cell)) 
(Yn (cadr New-cell)) 
(Xc (car Center-cell)) 
(Yc (cadr Center-cell))) 
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(cond ((null (aref *cell* Xn Yn 1)) ; If New-cell not explored 


(setf (aref *cell* Xn Yn 1) ; yet, and is not an obstacle, 
Center-cell) ; Center-cell becomes its parent 
(set-opl Xn Yn Xc Yc) ; Set Opt-Path-List for (Xn,Yn) 
(setf (aref *cell* Xn Yn 0) ; Decrement cost 
(- (aref *cell* Xn Yn QO) I)) 
(cond ((<= (aref *cell* Xn Yn 0) 0) ; If Newcell is fully explored 
(setq *backpath-pixel-list* 5 
(append ; 
(qet-backpath Xn Yn) ; add its parent to the 
*backpath-pixel-list*)) ; display list of parents 
(list New-cell)) ; and add New-cell to wave. 
(t (setq *finished-with-cell-p* ^ If New-cell is not fully 
nili) ; explored, don't add to wf, 


; and note that Center-cell 
; must stay on wavefront. 


(land (= Xc (car (aref *cell* Xn Yn 1))) ; If Newcell’s parent is 
(= Yc (cadr (aref *cell* Xn Yn 1))) ; Center-cell and Newcell 
(^ (aref *cell* Xn Yn O) O0)) ; not fully explored, 
(setf (aref *cell* Xn Yn O0) ; Decrement cost. 
(- (aref *cell* Xn Yn 0) 1)) 
(cond ((<= (aref *cell* Xn Yn 0) 0) ; lf Newcell is fully explored 
(setq *backpath-pixel-list* 

(append ; Add parents to the 
(get-backpath Xn Yn) ; backpath display 
*backpath-pixel-list*)) 

(list New-cell)) ; Add current new cell to wf 
(t (setq *finished-with-cell-p* ; If New-cell is not fully 
nil)))) ; explored don't add it to 


; wf,and note that Center 
; must stay on wavefront. 
(t nil)))) ; If Newcell was already explored, don’t add to wave. 


ARRRARRARARARE RA AAA RARA REA RRE RRA RRA AAA RARA AAA AAA NN LLL 


;***** Function orthog-expand: explores a cell which is in an orthogonal 


PARA direction from the cell being expanded. 

pea aoe Arguments: the first argument is a list of the X,Y 

P AREA coords of the cell being explored; the second is a list 
SNR RR of coordinates of the cell on the current wavefront 
SERENA being expanded from. 

o HAN Returned: A list of two elements: the first is a list of 

ii new cells to be added to the new wavefront and the second 
o o is a flag set as indicated above (in diag-expand) 


po ee Side Effects: Sets the parent coords of New-cell if they are nil 
(defun orthog-expand (New-cell Center-cell) 
(let ((Xn (car New-cell)) 
(Yn (cadr New-cell)) 
(Xc (car Center-cell)) 
(YC (cadr Center-cell))) 


(cond ((null (aref *cell* Xn Yn 1)) ; If New-cell not explored 
(sett (aref @eelt* Xp )) ; yet, and is not an obstacle, 
Center-cell) ; Center-cell becomes its parent 
(Set-opmen Yn ser c) ; Set Opt-Fath-List for (Xn 
(setf (aref *cell* Xn Yn 0} ; Decrement cost 
(- (aref *cell* Xu Yn O) 1.414)) 
(cond ((<= (aref *cell* Xn Yn Q) 0) ; If New-cell is fully explored 
(setq *backpath-pixel-list* : 

(append ; Add its parent to the 
(get-backpath Xn Yn) ; display list 
*tbackpath-pixel-liəst*)) ; 

(append (overflow ; Explore next cell in dir- 
New-cell ; ection of expansion & add 
Center-cell) ; any overflow cells. 

(list New-cell))) >: Add current new cell to wf 
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nil) 


nil))) 


mete Tight of overflow cells. 
(t (setq *finished-with-cell-p* ; 


vo "o "e 


( (and (= Xc (car (aref *cell* Xn Yn 1))) 
(= Yc (cadr (aref *cell* Xn Yn 1))) 
(> (aref *cell* Xn Yn Q) Q)) 
(setf (aref *cell* Xn Yn Q) 
(- (aref *cell* Xn Yn QO) 1.414)) 
(cond ((<= (aref *cell* Xn Yn Q) Q) < IE 
(setq *backpath-pixel-list* 
(append Ad 


(append 


(t (setq *finished-with-cell-p* 
nil))) 


(t nil)))) 


(get-backpath Xn Yn) 
*backpath-pixel-list*)) 


(overflow 
New-cell 
Center-cell) 


(list New-cell))) 


nil) 


r 
; ba 


ecti 
any 
; Add 


e =e =e 


Else if Newcell not 

fully explored don't add 

it to wf,and note that 

Center-cell stays on wf. 
; If Newcell’s parent is 
; Center-cell: 


; Decrement cost. 
Newcell is fully explored 


d parents to the 
ckpath display 


Explore next cell in dir- 


on of expansion & add 
overflow cells. 
current new cell to wf 


; to right of overflow cells. 


"e. "e "o "e 


If New-cell is not fully 
explored don't add it to 
wf,and note that Center 
must stay on wavefront. 


; If Newcell was already explored, don’t add it to wf. 


woo o 0 x x X0 À Àx Ax HARRAH AKR AAA AA ARA AA ARA ARA RARA RARA RARA AAA RARA RARA A A ARA RRA AAA X A 


ao ^. ™ 


***** Fonction overflow: 


determines wbether expansion should continue 


ERA A into the next cell in the (orthogonal) direction in which 
EARRA it has been going, and expands if necessary. 

aoe tt Arguments: the first is a list of the X,Y coords of the cell 
; A A into wbich the wave will overflow; the second is the coords 
oR AR KS of the cell from which it overflowed. 

;* ke Note that Center-cell in this function is the variable 

moo called New-cell in orthog-expand, and Farent-cell here is 
en called Center-cell in orthog-expand. 

MEER Returned: A list of cells to add to wavefront 


aa" Side Effects: 
(defun overflow (Center-cell Farent-cell) 
(car Center-cell)) 
(cadr Center-cell)) 
(car Farent-cell)) 
(cadr Parent-cell)) 
Xc Xp))) 


(let* ((Xc 
(Yc 
(Xp 
(Yp 
(Xn 
(Yn 


(New-cell 


GE Xe (- 
Ch ve. (= 


cell costs are decremented 


Yc Yp)) 


(overflow-cost 


(cond ((nul 


A 


(cond ((null (aref 
(setf (aref 


Cente 


1 (aref 


) 


(list Xn Yn)) 


*cell+* 


; Explore the next cell in the direction 
; of the previous expansion 


xn xn 0))109 : 


(aref *cell* xe Yc 0) 


(aref 

*cel]* 

pes 
r-cell) 


*cell* 
Xn Yn 
Xn Yn 


(set-opl Xn Yn Xc Yc) 
(setf (aref 
overflow-cost) 


(cond 


(set 
(a 


"cel 


An Yn 


Zn Yno0) 09 ; 


1)) 
1) 


0) 


((< overflow-cost 0) 


. 
f 
. 
, 
* 
, 


. 
, 


ge*backpathspa»wl-1x:st- 


ppend 


(qget-backpath Xn Yn) 
^baeckppsthb-pasxeh-T3239€8*)2) 
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Check if overflow is at 

a boundary; 

if not,decrement overflow 
cell by the (negative) 
amount left over froin 
previous cell. 


If overflow cell is unexplored, 
Set overflow cell parent 

to the explored cell. 

Set Opt-Path-List for (Xn, Yn) 


; Add parent to the 
; backpath display. 


(append (overflow ; If more overflow, expand again, 
New-cell ; and add Newcell to wave list. 
Center-cell) 
(list New-cell))) 
(t mil))) ; Else put nothing on wavefront. 
(t nim ; Else put nothing on wavefront. 
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X xe oe oe eoe on oe x 0 e 0x Fn xA x 0 x 0 x 0 xn x4 0 KR KK HDI DI HII DI HIRI KIKI IIH ARMA IAKKRER AAA ARA RA AA RA A A 


d, eee oe oe oe hoe oe oe oon o0 o eoe oe e e 0x ee oen 0e on x ee x Ix e fn Ax xà xn x4 0 9x Ax Fx x 9A Ax xn An xn 4 0 Àx4 Fx Me à An ARA ARA AR Ix 


***** "declar" contains the declarations of global variables used 
fees by "opm". It is loaded by function "opm" in file "opm.lisp". 
P***** This version is for use with maps in the form of a rectangle 


meer = * of characters. 
RR 


Se***** Current as of 7 Jun 89 
SAX * X * 


=e "an Pe We 


peewee Side Effects: initialization of *cell* and *boundary* arrays, 


HE ^^ and other global variables as listed below. 
HELENA KOC CON GO UR COCOA I 0 0I e II UII GN e A 0 


BEEN EARS EARN ROROKOROR RR GRON YAN OKOKOR NUR A UN 


¿*A**%* Global Variables: 


(defvar *version*) 

;(setf *version* "pure") (setf *vertex-list* nil) (setf *edge-list* nil) 

(setf *version* "vertex-edge") 

; (setf *version* "diverging-path") (setf *vertex-list* nil) (setf *edge-list* nil) 
(defvar *incremental-bdry-check*) ¡¿FARARAA get to 't if check-boundaries should 


(setq *incremental-bdry-check* 't) ;***** be done at each expand-cell, nil if not. 
(defvar *internal-timel*) 


(defvar *external-timel*) 
(defvar *internal-time2*) 
(defvar *external-time2*) 


(defvar *map-width*) ;***** Max allowable number of columns in the 

(setq *map-width* 205) ; Inap + 2 for bordering columns of blanks 

(defvar *map-length*) ¿*ARARA Max allowable number of lines in the 

(setq *map-length* 155) : map (-153) * 2 (-155) for the bordering lines of blanks 


(defvar *magnification*) ;***** Magnification of the screen. 
(setq *magnification* 3) 


“e 


(defvar *river-cost*) ¿***RA% Cost to cross a river 

(setg *river-cost* 16) 

(defvar *road-cost*) 21*4**4*4Cost to use a road 

(setq *road-cost* 0.1) 

(defvar *mapline*) P***** Array to hold the input map: each element 
(setf *mapline* ; is a string, each of whose characters 


(make-array 
(list *map-length*))) 


"e. 


represents one cell of the map. 


(defvar *terrain-pixel-list*) ; List to hold coordinates 

(setq *terrain-pixel-list* nil) ; of terrain pixels. 

(defvar *boundary-pixel-list”) ; List to hold coordinates 

(setq *boundary-pixel-list* nil) ; of boundary pixels. 

(defvar *backpath-pixel-list*) ; List to hold coordinates 

(setq *backpath-pixel-list* nil) ; of backpath pixels. 

(defvar *finished-with-cell-p*) ; Flag to record if cell stays on wave. 

(defvar *output-stream*) ; Can be used to define output stream 

(defvar *goal*) |*^^*** coordinates of goal pornt 

idefvar *cell*) ¿RARA 3-dimen array whose first and second indices 

Esetf *cell* : are the cell coordinates and whose third index 
(make-array ; specifies the attribute: 

(list $ Attribute O0 is cost to traverse the cell, 
*map-width* i decremented as wave passes over cell, 
*tmayp-length*  ; Attribute ] is list of parent’s coords 
31) ; if specified, nil if not. 


; Attribute 2 13 list consisting of the 
; character symbol of the cell, followed if 
; if applicable hy an edge id and vertex flag 
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(defvar 


*boundary*) 


(setf *boundary* 
(make-array 


(list 
*map-width* 
*map-length* 
2) 


ANA 


:element-type 'bit)) 


SARRAR 


(defvar 
(defvar 


*edge-list*) 
*vertex-list*) 


. 
t 


. 
t 


Attribute 3 is coords of opt-path-list parent 
Bit-valued array to mark region boundaries. 
The (X,Y,0) element specifies whether there is 
a boundary to immediate right of cell (X,Y). 
The (X,Y,1) element specifies whether there is 
a boundary immediately below cell (X,Y). 

Altho this array has enough info to specify 
boundaries between pixels, pixel (X,Y) is 
plotted as the boundary. 

These lists are for the heuristic version, and 
list all edge cells with edge id & vertex cells. 
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;; -*- Mode: LISP; Syntax: Common-Lisp; Package: USER -*- 


AAA RIA RA RARA AREA UK UNUK XC CAU OU MANU 


Y 00000 x A0 x0 00 x0 ARA AAA AAA AAA AAA AAA ARA AAA AAA AAA AAA AAA AAA AA AAA AAA A 


S***** "initmap" contains the functions used by "opm" to examine 


we Se = 


***** the map symbols and encode them into elements of the 


E *cell* array. It is loaded by function "opm" in file "opm". 


***** This version is for use with maps in the form of a rectangle 
mS" of characters. 


Ass: 


Lea "e "ao "eo ë F 


***** Current as of B8 Jun 89 
AAA A 


***** Input: file "map", an array of cell attributes 
*o ok 


E Side Effects: Loads file "map.lisp", and sets the 


ve "o. "e 


KA KK elements of the *cell* array according to the 


MERDA associated map symbol. Adjusts *map-width^*. 
RIERARAAARA AAA AA RAR ARA AAA ARA RAR AAA ARA AAA ARA AAA AAA AAA AAA AA AAA AAA A) A 


RIERARA RAR AAA RRA R RARA RARA RARA RARA RARA RARA AR AAA AAA AAA AAA AA ARA AAA AA AA A A 


***** Function "initialize-map" initializes the values of the 


IRAE array *cell* according to the information encoded 

ARARA in graphic form in the file "map". 

AA A Arguments: none 

EN Returned: t in all cases. 

ph*kkk Side Effects: Loads the Lisp file "map". 

RRA Initializes the arrays *cell* and *boundary* 
RARA A and adjusts the variable *map-width*. 

AA Functions Used: process-line, process-char 


(defun initialize-map () 


(load "map") (linefeed) (linefeed) 
(princ "Initializing Map") (linefeed) 
(cond ((equalp *version* "vertex-edge") 
(process-vertex-info *vertex-list*) 
(process-edge-info *edge-list*))) 
(setq *map-width* (* 2 (length (aref *mapline* 1)))) 
AGEN (I O {i+ I))) 
((= *map-width* 1)) ; Initialize the top 
(process-char #\x I 0)) "buffer zone" row 
etd 1 (1+ J))) 
((string-equal “eof" (aref *mapline* J)) 
ASIA O(I -1))) 
((= *map-width* 1)) ; Initialize the bottom 
(process-char #\x I J))) ; "buffer zone" row 
(cond ((>= J *map-length*?) 
(princ 'IWARNING: Map too long, will be truncated|) (linefeed) 
(process-line (aref *mapline* *map-length*) 1 *map-length*)) 
(t 
prine s Processing Map Row ") (prinl J) (linefeed) 
(process-line (aref *mapline* J) 1 J)))) 
(princ "Finished Initializing Map") (linefeed) (linefeed) ) 


=e 


ee ea AE AR AAA ARA RARA AAA ARA ARA RAR AAA AAA RADA o NU A n xn n 


m Xhunction "process-line" cycles thru each character of the 


coon. A argument (a string) up to the max allowed width of the map. 
o Bey processes each character and sends a warning 

LE * message to the screen if line is too long. 

NM Arguments: Line, a string 

s * Returned: t in all cases. 

ANA Side Effects: Sets a l-pixel border in right & left columns 


25S 


;A*AAX represented as an obstacle. 


Functions Used: process-char 
(defun process-line (Line X Y) 

(cond ((= 0 (length Line) ) ; Normal base case 
(process-char fix O Y) ; Initialize the right and left 


otk 


(process-char #\x X Y)) ; "buffer zone" columns 
(t (process-char (character (subseq Line O 1)) X Y) 
(setq X (14 X)) 
(cond ((»- X *map-width^") ; Abnormal case if map is too wide 
(process-char fx O Y) ; Initialize the right and left 


(process-char #\x (1- X) Y) ; "buffer zone" 
(princ 'IWARNING: Map too wide, 
(t (process-line 


columns 
will be truncated!) (1inefeed)) 
(subseq Line 1) X Y)))))) 


SRRARARARARARA RARA RARA RAR ARA RARA ARA RARA RA AA ARA AAA ARA RA AA RA AAA AAA AAA AAA 


;***** Function “process-char™ decodes each character of the map, 
RRA setting the cost element and in some cases the parent 
QI of the cell indexed by X and Y, the cell's coords, 
có Es and the parent of the cell on the Optimal-Path-List 
hai Es Arguments: Char, a character, and X & Y, integers. 
TAAA Returned: not applicable. 
o AnA AN Side Effects: Sets the values of the (X,Y,0) element of the 
A *cell* array to the cost as specified by the character; 
A in some cases sets the values of the (X,Y,1) and (X,Y,3) 
AS elements for cells having no parent. 
AAA Functions Used: no user-defined functions. 
(defun process-char (Char X Y 
&aux X- X+ Y- Ył) 
(setg X- (- X (/ 1 tfmagnification II) 
(setq X+ (+ X (/ 1 *magnificationm pii) 
(setq Y- (- Y (/ 1 *magnification*))})) 
(setq Y+ (+ Y (/ 1 *magnification*))) 
(cond ((and (>= (char-int Char) 49) (<= (char-int Char) 57)) 
(setf (aref *cell* X Y 0) (- (char-int Char) 48)) 
(setf (aref *cell* X Y 1) nil) 
(set£ (aref *cell* X Y 2) (cons Char (aref *cell* X Y 2))) 
(setf (aref *cell* X Y 3) nil) 
(cond ((= 1 (aref *cel1* X Y 0)) nil) 
(t (setq *terrain-pixel-list* 


(append 


(mapcar 'magnify-pixel 
(list 
(list X Y))) 
*terrain-pixel-list*))))) 


( (equal Char #\ ) 


(setf (aref *cell* X Y Q) nil) 
(setf (aref *cell* X Y 1) (list X Y)) 
(setf (aref *cell* X Y 2) (cons Char (aref *cell* X Y 2))) 
(setf (aref *cell*^ X Y 3) (liist X Y))) 
((equal Char #\x) 
(setf (aref *cell* X Y O) nil) 
(setf (aref *cell* X Y 1) (list X Y)) 
(setf (aref *cell* X Y 2) (cons Char (aref *cell* X Y 2))) 
(setf (aref *cell* X Y 3) (list X Y)) 
(setq X- (- X (/ 1I *magniztrestiam= op) 
(setq X4 (4 X (/ 1 *magnification*))) 
(setq Y- (- Y (/ 1 *magnification*))) 
(setq Y4 (4 YwW/ l *madgmfieatuwm))) 
(setq *tenrain-pixel-list$ 
(append 
(mapcar ‘magnify-pixel 
(last (list X- Y-) 
(Js tee) 
(ist X- IVF) 
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(setf 
(setf 
(setf 
(setf 
(setq 
(setq 


(list 
(list 
(list 
(list 
(list 
(list 


=) 

x Y) 

X Y+) 

X+ Y-) 
XF Y) 

XF Y+)})) 


terrain pixel-list*))) 
( (equal Char #\r) 


(aref 
(aref 
(aref 
(aref 
X+ (+ 
xe qq 


*cell* 
eee 
ce LE* 
wee] 1 
Xal l 
yY (/ i 


0) 
1) 


river cost?) 
nil) 
2) (cons Char 
Y 3) nil) 
*magnification*))) 
*magnification*) )) 


MOM OM 


(are fe co^ x y" 7»)) 


S MOX X 


Y4 (+ Y (/ 1 *magnification*))) 
*terrain-pixel-list* 
(append 
(mapcar 'magnify-pixel 
(list (list X+ Y-) 
(list X+ Y) 
(list X+ Y+))) 
Fterrain-pixel-13ist*))) 
((equal Char Hp) 


(setq 
(setq 


(setf (aref *ceJ1* X Y 0) *road-cost*) 
(setf (aref *cel1* X Y 1) nil) 
(setf (aref *cell* X Y 2) (cons Char (aref *cell* X Y 2))) 
(setf (aref *cell* X Y 3) nil) 
(setq *terrain-pixel-list* 
(cons (list X Y) *terrain-pixel-list*))) 
( (equal Char #\G) 
(setq *goal* (list X Y)) 
(setf (aref *cell* X Y QO) 1) 
(setf (aref *cell* X Y 1) (list X Y)) 
(seer (aref *cell* X Y 2) (cons Char (aref *cell* X Y 2))) 
(setf (aref *cell* X Y 3) (list X Y))))) 


KARA AAA AAA AAA RA AAA AAAAR ARA RA AAA AAA ARA AAA AAA AAA AAA AAR AAA AAA AAA ARA A 


;**^*** Function "process-vertex-info" puts the character v into each 
A *cell* X Y 2 as a list (#\v). This becomes the third element of 
aut this list after "process-edge-info" and "process-char" happen. 
(defun process-vertex-info (v-list) 
(setf (aref *cell* (caar v-list) (cadar v-list) 2) 
(list $iv)) 
(cond ((null (cdr v-list))) 
(t (process-vertex-info (cdr v-list))))) 


AAA ERRATA RARA RARA RARA NARA RARA RRA RARA RARA RAR RARA AAA RARA RA AA AAA AAA 


¿RRRAR Function "process-edge-info" puts the id number of the appropriate 
A edge into *cell* X Y 2 as the first element of the list there. 


ae This becomes the second element of the list after 


is executed. 

me ati ista list of triples: e.g., 

COX Dyes) (UV 21) (2 W 2)), where for example, 
id number of the edge on which cell (X Y) 
(e-list) 


"process-char" 
HR ur 


e. RR de > 
, 


ok kkk de 
, 


13 is the 
is located. 


~ tke te & 
, 


(defun process-edge-info 


(et ((X (first (fest e-list))) 
(Y (second (first e-list))) 
(EdgeID (third (first e-1ist)))) 
(cond ((characterp >; lf cell is a vertex, and 
(first (aref *cell* X Y 2))) , no other edge id has been 
(setf£ (aref *cell* X Y 2) ; set for this cell, set lst 


(cons (list EdqeliD) element of list to EdgelD, 
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(aref *cell* X YT mio) 
((null (first (aret *cell* 421220) 


; 1£ Cell 19 not a vtx, andan 
(setf (aref *cell* X Y 2) 


; other edge id has been set, 


(list (list EdgelD)))) ; set EdgeID 
((listp (first (aref *cell X Y2} ; If another edge id has 
(setf (aref *cell* X Y 2) ¿ been set for this cell, 
(cons (cons EdgeID ¿ cons EdgelD onto the 
(first (aref *cell* X Y 2))) ; lst element of the 


(rest (aref *cell* X Y 2)))))) 
(cond ((null (rest e-list))) 


(t (process-edge-info (rest e-1ist)))))) 


; previous list. 
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Mode: LISP 


mov ntax: Common Lisp; Package: USER -*- 


EMEN UU EULUSADSNNNUNONNUNUNONORORDNONCNOR ee eoe ee AO ROROXUOO Y ACRONOACUU0& 


en AAA AKA AA KAA KAKAKAAAAAKAAAKKRAAKAEKKNKARRKARAAKKAKHHAHKKKKHAKKSH 


¿RARA File "bdry" contains the functions which detect and record 
¿***** boundaries between terrain cells. It also sets and checks 
S***** equivalence between optimal-path lists. 

ROSSO 

:***** Current as of 27 Jun 89 

on ae 


HEEL LL AAA ARRARRARARA RR AAA RAAARARAR ARA RRA RARA AA RARA RR RARA RARA RAA RRA ARO 


AAA AA RARA RARA RARA RARA ARA AA RAR RARA RARA RARA A RARA RARA AA RARA AAA ARA 


EEUU ROROACAOR KO CACKCKOROKON OCA 0I OI UU 0 0e NOU 0 0 M e 


:***** Function 


HONOR NA 
SONA k 
SORIA 


ek Ak ko 
? 


"check-all-boundaries" iterates through the whole map 


to find boundaries. It is used when boundary-checking is done 
after completion of wavefront expansion. 
Arguments: None 


Returned: 


not applicable 


(defun check-all-boundaries () 
(setf£ *boundary-pixel-list* nil) (linefeed) 


*version*) 


((string-equal "eof" (aref *mapline* J)) 
(linefeed) (princ “Finished With Boundary Detection") (linefeed) (linefeed)) 
(princ "Pure Bdry Detection for Row ") (prinl J) (linefeed) 


CET 199) 
*map-width*)) 
Aouri (aref ^celt* UE T) JT 1))) 
((oure—bdry—condition 

IJ (1I TI) J) 
(ada—-to-bdry “i J {1+ I). J)})) 
((null (aref *cell* I (14 J) 1))) ; Check (I,J) against 
((pure-bdry-condition ¿A JA 

A) 
(dd to bdry I J I (19% J)))) 
( (null (aref *cell* (1+ I) (1+ J) 1))) ; Check (I,J) against 
( (pure-bdry-condition ; (141, J+1) 

I J {1+ I) (1+ J)) 
aga -to-bdry =I J (1+ I) (1479) )))))) 


Check (I,J) against 
(TEITI) 


". "a 


"diverging-path" *version*) 


((string-equal "eof" (aref *mapline* J)) 
(linefeed) (princ "Finished With Boundary Detection") (linefeed) (linefeed) ) 
(princ "Diverging-Path Bdry Detection for Row ") (prinl J) (linefeed) 


RTII) 
*map-width*)) 
((null (aref *cell* (1* I) J 1))) "check r,J) against 
((diverging-path-bdry-condition ; (I*1,J) 
Toler | + eek). D) 
(add-to-bdry I J (1+ I) J))) 
Bulls (aref *cell* i (it J) 1))) "acheckwettobvagarnst 
((diverging-path-bdry-condition UL) 
ESJ I (14329 
ladd to Ddry I J TUE.) )) 
Anull aref *cell* “(1+ I) (14 3) 1))) ; Check (I,J) against 
((diverging-path-bdry-condition pe Lt a) 
I J (1+ I) (1+ J)) 
(add-to-bdry I J (14+ I) (1+ J))))))) 


"vertex-edge" *version*) 


(cond 
( (equal "pure" 
de” ((J 1 (1+ J))) 
(do ((1 1 
( (>= I 
(cond 
(cond 
(cond 
( (equal 
(do t(tJ 1 (14+ J))) 
(do ((1 1 
>=" T 
(cond 
(cond 
(cond 
( (equal 
ideo (tJ 1.414 


J))) 


((string-equal "eof" (aref *mapline* J)) 
(linefeed) (princ "Finished With Boundary Detection") (linefeed) (linefeed)) 


ole 


(princ "Vertex-Edge Bdry Detection for Row ") (prinl J) (linefeed) 
(do ((1 1 lA 
((>= I *map-width*) ) 
(cond ((null (aref *cell* (1+ I) J 1))) 3: Check (I,J) against 
((vertex-edge-bdry-condition ; (1+1,J3) 
I J (14+ 1) JO {ist I J (0H 
(add-to-bdry Tog (i+ 1) Je 
(cond ((null (aref *cell* I (1+ J) 1?) ; Check (I,J) against 
((vertex-edge-bdry-condition s CINES 
IJ I (1+ J} O (list 1 J 1 (1929193 
(add-to-bdry 7 J 2 (ise 
(cond ((null (aref *cell* (1+ I) (14 J) 1))) ; Check (I,J) againsk 
((vertex-edge-bdry-condition = (I+1,J+1) 
I J (1+ I) (1+ J) O (list I J (14+ 1) (1+ J))) 
(add-to-bdry I Jg (1t) [LE DD) 


;SWUARNRAA Ak A A X A NU X KO CUN X GN AG UNO OR UNUNURON RACROR UN ee 


;***** Function "check-for-boundaries" checks each of a cell's four orthogonal 


AS neighbors for the existence of a region boundary. It is used 

SERA when boundary-checking is done incrementally during wave expansion. 
SN NE Arguments: Center-cell,a list of the coords of the cell being 

pha nae checked and aux (local) variables to hold the coords 
PEMAAA Returned: not applicable 

(DEUS Side Effects: if bdry exists, the appropriate pixels are added 

¿EN to *boundary-pixel-list* and *boundary-bit* (X,Y) is set. 

SAMBA Functions Used: check-neighbor 


=e ee 


(defun check-for-boundaries (Center-cell 
&aux X Y) 
(setq X (car Center-cell)) 
(setq Y (cadr Center-cell)) 


(cond 
((equal "vertex-edge" *version*) 
(cond ((null (aref *cell X (1- Y) 1))) ; Check (X,Y) against (X,Y-1) 
; If (X,Y-1)'s parent is undefined 
; boundary cannot be checked yet, 
((vertex-edge-bdry-condition ; Else it can so call bdry condition. 
XY XAI YO (Sst ye E YT 
(add=to=bdry MY AL ; If bdry-cond = T, add to bdr D 
(cond ((null (aref *“cell* (1-332) 
((vertex-edge-bdry-condition ; Check (X,Y) against (X 1P) 


X Y (1= X) YO (list oy ee 
(add-to-bdry Y Y Db DP 
(cond ((null (aref *cell* X (14 Y) 1))) 
((vertex-edge-bdry-condition ; Check (X,Y) against (X,Y+1) 
X YX (1+ Y) 0 (1ist A YA eee 
(add-to-bdry X Y X (1* Y)))) 
(cond ((null (aret *cell* (1+ X) Y 11i} 
((vertex-edge-bdry-condition ; Check (X,Y) against (X*1,Y) 
X Y (1- X) Y O0 (Iist X A 
(add-to-bdry X Y (14 X) Y)))) 
((equal "pure" *version*) 
(cond ((null (aref *cell* (MO ; Check (X,Y) against (X,Y-1) 
; If (X,Y-1)'s3S parent is undetinee 
; boundary cannot be checked yet, 


((pure—bdry-conait ren ; Blse it can so call bdry condition 
X Y X (1- Y)) 
(add-to-bdry XY X (E Yo ; If bdry-cond = T, add to bd 
(cond ((null (aref *cell* (1- X} Y 1)?)) 
((pure—bdry-cond1 19m ; Check (X,Y) against (X-1,Y) 


X Y (1- X) Y) 
(add-to-bdry X Y (1- X) Y))) 
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(Cond ((null (aref *cell* YX (1+ Y) 1))) 
((pure-bdry-condition ; Check (X,Y) against (X,Y+1) 
X Y X (1+ Y)) 
(add to-bdry X Y X (14+ Y)))) 
(cond ((null (aref *celi™ (14+ X} Y 1))) 
((pure-bdry-condition ; Check (X,Y) against (XLl,Y) 
X Y (1+ X) Y) 
(add-to-bdry X Y (1+ X) Y)))) 
( (egual "diverging-path" *version*) 
(cond ((null (aref *cell* X (1- Y) 1))) ; Check (X,Y) against (X,Y-1) 
; If (X,Y-1)'s parent is undefined 
; boundary cannot be checked yet, 
((diverging-path-bdry-condition ; Else it can so call bdry condition. 
XY X l=- Y) 
(add to bdry X Y X (1- Y}}))) ; If bdry-cond = T, add to bdry-list. 
(cond ((null (aref *cell* (1- X) Y 1))) 
((diverging-path-bdry-condition ; Check (X,Y) against (X-1,Y) 
X Y (DX) 
(add-to-bdry X Y (1- X) Y))) 
(cond ((null (aref *cell* X (1+ Y) 1))) 
((diverging-path-bdry-condition ; Check (X,Y) against (X,Y+1) 
X Y X (1+ Y)) 
(add-to-bdry X Y X (1+ Y)))) 
(cond ((null (aref *cell* (1+ X) Y 1))) 
( (diverging-path-bdry-condition > Check (X,Y) against (X+1, Y) 


- AHORA 


X (It X) Y) 


(add-to-bdry X ¥ (14+ X) Y)))))) 


QOO NO COO AAA COO OA IU COUR 


Function "vertex-edge-bdry-condition" checks if there is a boundary 


;,***** between two cells by seeing if their OFL's have equivalenpt "critical" 
P****^* points, where a critical point is a turn-cell which is on an edge 
n or is adjacent to a terrain-feature vertex. 
;***** Arguments: Coords of 2 cells which may be in different regions; 
| EE Flag which is O0 normally, but for double-edged cells on the 
¡A second recursive call with that cell is a list of the left-over edge- id, 
AA and for edge-interior pairs is 1 or (edge-id) after initial call. 
NS Retuened: n11l if condition does not hold, and T 
ris ia if condition does hold. 
1 side Effects: none 
SOR NO 
(defun vertex-edge-bdry-condition (X1 Y1 X2 Y2 Flag StartPoints) 
(let* ((Xsl (first StartPoints) ) ; bdry cond based on vertex 
(Ysl (second StartPoints) ) ; and edge turn points. 
(Xs2 (third StartFoints)) 
(Ys2 (fourth StartPoints)) 
(Farentl (first-distinguished-opl-cell Xl Yl Xsl Ys1)) 
(Parent2 (first-distinguished-opl-cell X2 Y2 Xs2 Ys2)) 
(Xp1 (first Parentl)) 
(Ypl (second Parentl)) 
(Xp2 (first Farent2)) 
(Yp2 (second Parent2))) 
(cond 
((not (equal ; Case A: If the start-pts themselves have 
(first (aref *cell* Xs1 Ys1 2})} ; different costs, they are in different 
(first (aref *cell* xs2 Ys2 2)))) ; regions. This condition fires only 
t) ¿ on the lst call to v-e-b-c. 
( (and ; Case Bl: If SFl is edge (& SF2 is inside same 
(< 1 (length (aref *"cell* Xs1 Ys1 2))) ; ran, by A above) and Parent of 2 
(equal ; 1s on the same edge as SF], and 
(second (aref *cell* Xs1 Ysl1 2)) ; SF1 is not the lst of a pair of 


(third Farent2) ) ; double-edge cells, do not put a 


(not (equal 
(second (aref *cell* Xsl Ysl 2 
(third Parentl)))) 

nil) 

( (and ; Cas 
(< 1 (length (aref *cell* Xs2 Ys 
(equal 

(second (aref *cell* Xs2 Ys2 2 
(third Parentl)) 
(not (equal 
(second (aref *cell* Xs2 Ys2 2 
(third Parent2)))) 
nil) 
((and (= Xpl Xp2) ; Cas 


(= Ypl Yp2)) nil) 


. 
, 


(land (= 3 (length Parentl)) 
(= 3 (length Parent2))) ; Cas 
(cond 
((set-equal (third Parentl) E 


(third Parent2)) 
(vertex-edge-bdry-condition 
Xpl Ypl Xp2 Yp2 O Star 
( (and ; 
(subsetp (third Parent2) 
(third Parentl)) 
(not (listp Flag))) 
(vertex-edge-bdry-condition 
X1 Y1 Xp2 Yp2 
(set-difference 
(third Parentl) 
(third Parent2) ) 
StartPoints) ) 


( (and E 
(subsetp (third Parentl) 
(third Parent2)) 
(not (listp Flag))) 


(vertex-edge-bdry-condition 
Xpl Ypl X2Z2WY 2 
(set-difference 

(third Parent2) 
(third Parentl)) 
StartPoints) ) 
((and 
(subsetp (third Parent2) 
(third Parentl)) 
(equal Flag 
(third Parent2))) 
(vertex-edge-bdry-condition 
Xpl Ypl Xp2 Yp2 O StartPo 
( (and ; 
(subsetp (third Parentl) 
(third Parent2)) 
(equal Flag 
(third Parentl))) 
(vertex-edge-bdry-condition 


; bdry between SPl & SP2. 
)) ; (This case makes edge cells & 
; interior cells be in same rgn.) 


e B2: If SP2 is edge (& SFl is inside same 
2 2100) ; rgn, by A above) and Parent of 1 
is on the same edge as SP2, and 
) ) ; SP2 is not the lst of a pair of 
; double-edge cells, do not putea 
; bdry between SP1 £ SP2, 
) ) ; (This case makes edge cells 4 
; interior cells be in same rgn.) 


e C: If Parentl £ Parent2 are the same, 
Ptl & Pt2 are in same region. 

e D: If parents are both edge cells: 

Case Dl: If edge-id lists are the same, 
; chk next pair of cells on OPL recursively 
; (Normal case) 

tPoints) ) 

Case D2: 

Else if Parentl is a double-edge cell and 
one of its edge-ids edge-id of Parent2, 
and this is the lst time Parenti has been 
checked in this set of calls to v-e-b-c 

; recursively check OPL with Foint1 and 

; Parent2, with flag (unmat ched-edge-id) 
of Parentl. (Only applies where cell 1 is 
is on two edges.) 


Case D3; 
; Else if Parent2 is a double-edge cell and 
; one of its edge-ids = edge-id of Parentl, 


; and this is the lst time Parent2 has been 


* checked in this set of calls to 


; v-e-bdry-cond, recursively check OPE ween 
; Parentl and Point2, with flag := 

; (unmatched-edge-id) of Parent2. 

Case D2, Second Pass: 

; Else if Parentl is a double-edge cell and 
; its previously unmatched edge-id = id of 


; Parent2, recursively check OPL from 


; Parentl & Parent2, with Flag = NIL. 
ints)) 

Case D3, Second Fass: 

Else if Parent2 is a double-edge cell 
; and previously unmatched edge-id = id 
; Parentl, recursively check OPL from 

; Parentl and Parent2, with Flag = NIL. 


and 
of 


. 
f 


xXxpl Ypl Xp2 Yp2 OStart homes), 
tt *t))) ; Case D4: 


(e ; 


e KA A AAA AA AAA AA AAA AAA A AAA A AAA ACA A AA AAA A AAA AAA AAA AAA RA RCA AA 
, 


;***** Function "first-distingÜUished-opl-cell" funds othemsurst cells 
ote gue the opl of Pt X,Y which is a "distinguished" point. It is called 


UR Ra bymfunetion “heuristic—bdry-condit sen. 
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Otherwise pts are in different rgns 
Case E: OTHERWISE pts are in different rgns. 


aoa aia Arguments: coords of the cell whose opl is being checked 

yo AG Returned: a list of the coordinates of the distinguished cell, 
a followed if it is an edge cell by the edge id num. 

E^ ^ Side effects: none 

(defun first-distinguished-opl-cell (X Y Xs Ys 


&aux Dcell) 
(cond ((equalp 
(list X Y) 
(aref *cell* X Y 3)) 
((setf Dcell 
(first (aref 
/ VSecona = (aren 
(cond 
((= 3 
( (not 
(fr Sit 
(first 


(list X Y)) > 
(distinguished-cell ; 
*cell* x Y 3)) : 
*cell* X Y 3)))) : 
(length Dcell)) 
(equal 
(aref *cell* 
(aref *cell* 
(first Dcell) 
(second Dcell) 


2)))) 


Dcell) 


Xs Ys 2)) 


me “e. “o "5 


Dcell) 


(t (first-distinguished-opl-cell 


(firstevaret “cell* X Y 3)) 
(second (aref *cell* X Y 3)) 
Xs s) 


(t £first-distinguished-opl-cell 


(first (aref *cell* X Y 3)) 
(second (aref *cell* x Y 3)) 
zogen) 


If opl-parent-point, cell is obstacle 
or goal, so return the point itself. 
(base case 2) 

If opl-parent is distinguished, rtn 
coords of parent and possibly the 
edge id number. (base case 3) 


If Dcell is edge cell, rtn Dcell. 
If Dcell is vertex and this path 
started outside the terrain feature 
of which Dcell is a vtx, rtn Dcell. 


; Else, recurse to look 
; at next cell on opl. 


; Else, recurse to look 
at next cell on opl. 


=» 


ec KET RR RAKKKAARREKENKRKARKRAKREARARWKERKAEKKKKKKEARKEKRKENKRERKRAKKEAKAKRKES 


;***** Function "distinguished-cell" determines whether cell is an edge 


NA A 


or adjacent to a terrain-feature vertex. 


ae. Arguments: coords of the cell being checked for disting. status 
aoe Returned: (X Y edge-id-list) if cell is on an edge 
2 olla (X Y) if cell is adjacent to a vertex 
E c^ nil if cell is not distinguished 
E ^ Side effects: none 
(defun distinguished-cell (X Y) 
Meis (1- X)) 
(X+ (1+ X)) 
(X= ()- 3) 
(Y+ (14+ Y))) 
(cond 
(({and (< 1 (length (aref *cell* X Y 2))) ; If (X,Y) is edge cell 
(equal ; and is the first of a 
(second (aref *cell* X Y 2)) ; pair of adjacent cells 
(second ; of the same edge in the 
(apef *cell* ; same backpath, 
(first (aref *cell* X Y 1)) "return nil. 
(second (aref *cell* X Y 1l)) 
EN 2 1) 
one (henguietarefis *"cell* =x Y 2))) ; If (X,Y) is a single edge cell, 
(list X Y (second (aref *cell* X Y 2)))) ; return coords & edge-id-list. 
((and (= 3 (length (aref *cell* X- Y 2))) 
moti (egualp (first (aref *cell* X Y 2)) >; Else if (X,Y) is 
(first (aref *cell* X- Y 2})))) ; adjacent to a vertex 
(list X- Y)) ; and is outside the 
((and (= 3 (length (aref *cell* X- Y+ 2))) ; terrain feature of 
(not (egqualp (first (arefo*cell* X^Y-2)) ; which the vertex is 
(frrstearef""cell* X-^vYt 2)))3) ; a part, return coords 
(list X- Y+)) ; Of vertex. 
( (and (= 3. (length (aref *cell* x 3-92))) 
(noe Neaqtake, (first (arer "eel x Y 2)) 
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(first (aref 


(list 209) 


( (and (= 3 (length (aref *cell* 
(not (equalp (first (aref 
(first (aref 

(list X- Yo) 
((and (= 3 (length (aref *cell* 
(not (equalp (first (aref 
(first (aref 


(listo MT 


((and (= 3 (length (aref *cell* 
(not (equalp (first (aref 
(first (aref 


(list X+ Y-)) 


((and (= 3 (length (aref *cell* 
(not (equalp (first (aref 
(first (aref 


(list X+ Y)) 


(land (= 3 (length (aref *cell* 
(not (equalp (first (aref 
(first (aref 


(list X+ Y4)) 
(t mrm) 


ce TINY 2)?)?})) 
X= YZI) 

*cell* X Y 2)) 
*cell* X- Y- 2))))) 


X YI 2)13) 
*cell* X Y 2») 
*cell* DA 0) 


Kt ee 
rcall X TPA) 
*cell* Oy 20D 


X+ v 2))) 
*cell* X Y 2)) 
*cell* X4 Y 2))))) 


X* Y* 2))) 
*cell* x Y 2)) 
*cell* X4 Y4 2))))) 


; Else (X,Y) is not adjacent to a vertex 
; and is not an edge cell 


gk x e x x Ax A x e ee e I e e e e e ke e e e e e e e ek ee ke e ee e e e Ie e e e e ee e ee e ki A 


;***** Function “add-to-bdry” sets the boutdary bI UO un 


e 


Mr uelut 


adds boundary pixels to the front of the boundary list 
unless one of the arguments is an obstacle cell. 


PDA Argument: coords of two points whose boundary 
ITA is to be added. 
A Returned: always returns T 
VE ME Side effects: Sets *boundary* bit to 1 and 
"orba obo sets *boundary-pixel-list* to the previous 
ea list with the new pixels appended to the front. 
SRR ROR 
(defun add-to-bdry (X1 Yl X2 Y2 
&Kaux Xa Xb Ya Yb) 
(cond 
((or (char-equal fix (car (aref *cell* X1 Yl 2))) 
(char-equal #\x (car (aref *cell* x2 Y2 2))))'t) 
(t 
(setq Xa (4 X1 (/ (- X2 X1) *magnification*))) 
(setq Ya (* Yl (7 (— Y2 Yl) *magnification?05D 
(setq Xb (4 Xl (^2 (/ (- X2 X1) *magnitacat rons) 
(setq Yb (4 Y1 (7 2 (/ (- X2 X1) *maonstication 08M 
(setf (bit "boundary* 
(min X1 X2) ; Set the boundary 
(min Y1 Y2) ; flag bit of tbe upper 
(cond ((— O (- Yl Y2)) 90) ; or leftmost cell. 
(toT) 
1) 
(setf *boundary-pixel-list* 
(append 
(mapcar 'magnify-pixel 
(cond 
((7 X1 X2) 
(list (list.(- X1 (/ IE magmi cationi) Ya) 
(list x1 Ya) 
(list (+ X1 (/ 1 *maenitveation Ya) 
(list (= Xl (/ I ?magnafricatdáon*')0 Yb) 
(list X1 Yb) 
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(list {/ l *magnification*)) Yb))) 


((— Yl Y2) 
(list (list Xa (- Y1 (/ 1 *magnification*))) 
(list Xa Yi ) 


(list Xa (+ Y1 (/ 1 *magnification*))) 
(list Xb (- Yl (/ 1 *magnification*))) 
(list Xb Y1 ) 
(list Xb (+ Y1 (/ 1 *magnification*)})}))}) 

(t 

(list (list Xa Ya) 
(list Xa Yb) 
(list Xb Ya) 
(list Xb Yb))))) 

*boundary-pixel-list*)) 't))) 


A AAA ERA ERE RARA RRA ERA COO AC I KO RR Fe RAR RARA RAMA AER 


EN Functron "set-opl" sets the coords for a cell's predecessor 
gk in the optimal-path-list. 


ge earns Arguments: Xn and Yn the coords of the new cell with OPL being 
oa * set and Xp and Yp the coords of (Xn,Yn)'s parent on backpath 
AAA Returned: not applicable 

AN Side Effects: sets *cell*(Xn,Yn,3) with n's predecessor on OPL 
SORA UA A v Functions Used: on-line-between 


ak 


melun set-opl (Xn Yn Xp Yp) 
(cond ((« 1 (length (aref *cell* Xp Yp 2))) ; If P is an edge cell, set 
(setf (aref *cell* Xn Yn 3) (list Xp Yp))) ; pred of N to FP. 

((on-line-between Xp Yp Xn Yn ; If P is between N 
(timswmtareto*cell* Xp Yp 3)) ; & pred of P on OPL, 

(second (aref *cell* Xp Yp 3))) ; set pred of NH to 

(Sect (areft "cell* Xn Yn 3) (aref *cell* Xp Yp 3))) ; pred of P. 
(t (setf (aref *cell* Xn xn 3) (list Xp Yp) jo) ; Else set pred of N 

; to P itself. 


$C 0 X Y G0 e e e I Y 0 eo e e I ehe 0 e e ee e eh ee ee eoe de hoe oe eoe e eh e 


EL Function “pure-bdry-condition" 
;***** Arguments: Coords of 2 cells which may be in different regions 
BE Returned: nil if condition does not hold, and T 


RM A if condition does hold. 
EL side Effects: none 
PORNO K 
(etun pure-bdry-condition (X1 Yl x2 Y2) e boundary condition: 
Mer? («(Xpl^ (car (aref *cell*.Xl Y1 3))) ; If OPLs are equivalent, 
OrpiIS(cadro(aref *cell* X1 Y1 3))) ; return nil, else return T 


(Xp2 (car (aref *cell* x2 x2 3))) 
Gpe (cadit ({aref *cell* X2 Y2 3))) 
(Xppl (car (aref *cell* Xpl Ypl 3))) 
(Yppl (cadr {aref *cell* Xpl Ypl 3))) 


XppPXicar (aref *cell* Xp2 Yp2 3))) ; OPLs are equivalent if 
(Ypp2 (cadr (aref *cell* Xp2 Yp2 3)))) ; first cells in each 
(cond ((and (= Xpl Xp2) ; OPL are equivalent, ie, 
(= Ypl Yp2}} nil} ; if they are the same, 
; or if one is in the 
((on-line-incl-between Pfirt leg of the 


pil Mp2 Yo2 XppZ2 Ypp2) nil) ; OPL of the other 
((on-line-incl-between 

Peep. Kl ym Xppl-YXppl) nil) 
((on-line-incl-between 

A La pe Yp2) nil) 
((on-line-incl-between 

a Yl XploYpl) nail) 
üuemuuuLroa-bdry xl Y1 xa vY2))))Y) 


0 Pe te HK BRK KR KK RK IKK KK He KHOR FHI KIRK IK KIRK HK IKK KIKI KHKKE KEKE x Ax |n x 
, 


;***** Fonction "divergindgspath-bdsy-coldTtrono 


: RAR AA 


:**** — Returned: 


if condition does hold. 
Side Effects: none 


> *ok * * * 
ok Kk * A 
, 


ek KKK 


(defun 

&aux 

(setq 
(setq 
(setq 
(setq 
(setf 
(setq 
(setq 
(setf 
(setq 
(setq 
(setq 
(setq 
(setf 
(setq 
(seta 
(setf 
(setq 
(seg 
(cond 


diverging-path-bdry-condition 


EC 
PN 
EXC 
EYG 
EEG 
PPXc 


(aref *cell* Xc Yc 1)) 
(aref *cell* Xn Yn 1)) 
(first FC)) 
(second PC) ) 
(aref *cell* 
(first PPC)) 
PPYc (second PFC)) 
FPPC (aref *cell* FFXc PPYc 1)) 
PPPXc (first PPPC)) 
PPPYc (second PPPC)) 
PXn (first PN)) 
PYn (second PN) ) 
PPN (aref *cell* 
PPXn (first FPH)) 
PPYn (second PFN)) 
PPPN (aref *cell* PPXn PPYn 1)) 
PPPXn (first PPPN)) 
PPFYn (second PFFN)) 
((and (= Xn FXn) 
( (bdry-condition-1 
PFPXc PPPYc PEPXn PPPYn) 
(addsto-budry X%c Ye Ans ime 
((bdry conditions z 
xc Yc PXn PYn) 
(add-to-bdry Xc Yc Xn yYn)) 
( (bdry-conditicn Z 
PXc PYc PXn PYn) 
(add-to-bdry Xe Yeux nn) ) 
((bdry-condzt t6n—3 
EPXCOPPYC PPAn PEYn) 
(add-to-badry Xc Yc Xn Yn) 
(t nil))) 


PXC- PXO 11) 


PXn FYn L3 


e 
t 
* 
, 


^*^** Function SbdEV condat oM 


Q**««* Arguments: 

;***^* Returned: nil if condition does aero. 
poet oe if condition does hold. 

Q^*^^* Side Effects nen] 


ok anak 
r 


(defun bdry-condition IMXI 7E YZ] 


(cond 
((or (< 2 (abs (- X1 X2))) 
(< 2 (abs (- Y1 Y2})))}) 
(t nrl)99 


(- Yn FYn))) ; 


=e 


, 


Arguments: Coords of 2 cells which may be in different regions 
nil if condition does not hold, 


and T 


(Xc Yc Xn Xn 
PC PXc PYc PPc PFXc PPYc PPPC PPPXc PPPYc PN PXn PYn PPn PFXn PPYn PFPN PPPXn PPPYn 


Find Center-cell's 
parent, grandparent, 
great-grandparent 


and 


Find Neighbor-cell's 
parent, grandparent, 
great-grandparent 


and 


Keeps obst from causing bdry. 


se “e Be 


e Me Me 


If greatgp’s are separated 
by more than two, cells are 
in different regions. 

If cell and neighbor’s 
parent are in different 
regions, so are cells. 

; If parents are in 

; different regions, 

; SO are cells. 

If gp's are separated by an 
obst or river cell, there 
is a bdry btwn cells. 


e =e ™ 


Raa RNR mama A A AA RA AA AA ACA AA AA RRA RR RA RRAARAR AAA AR ARA ARA AAA RARA RARA AR RA 


Coords of 2 cells which may be in different regions 


and T 


Boundary condition 1: 


> If cells are more than 2 cells 
; apart, return. “true” 


PR RRR HARE EANREE ERS RRRARA KK ERRA REE KERR ARR ROKR ROK RR Oe eee A DA eee eee 


¿FEA Function "barco 2 


¿AREA me test 
***** Returned: nil if condition does not) nora 


I A ae condition does hold. 


 **^^*^ Side Effects: none 


to* 0 o o 
, 


(defun bdry-condition 2 (2YE) 


Coords of 2 cells which may be in different regions 


and T if 
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(cond ; Boundary condition 2: 


((and 
= 1 (4 (abs (- X1 X2)) ; If cells are adjacent, 
(abs (- Y1 Y2)))) 
(not (equal (list X1 Yl1) ; and one is not the 


(aref *cell* X2 Y2 1))) ; parent of the other, 

(not (equal (list X2 Y2) 

(aref *cell* X1 Y1 1))) 
(bit *boundary* ; and bdry bit is set, 

(min Xl X2) 

(min Y1 Y2) 

(cond ((= 0 (- Y1 Y2)) O0) 

Cs dd 

TE) ; then return "true" 
(t nil))) ; else return "nil" 


O 
It 
m 


ATAR RA RARA ARRARAARA RARA e e e e I I e e e e A A I A A e X x M n X A I A I x SE 


;,*"**** Function "bdry-condition-3" checks if points are separated 
DP***** by exactly one obstacle or river cell. Tf so, under the 
p**ek** Circumstances in which cond-3 will be called, they are in 

BE different regions. 

P***** Arguments: Coords of 2 cells which may be in different regions 
;***** Returned: nil if condition does not hold, and T 

ee if condition does hold. 

Side Effects: none 

;***** NOTE: nested cond’s are arranged as they are to detect as soon 


ae ke as possible when the conditions will not hold, because this test 
MA Ame must be run 4 times for every cell in the map, and only occasionally 
ge keane will the =2,=0 conditions be true. 
A 
pehumdbdry-condition-3 (X1 Yl X2 Y2) ; If cells are 2 apart horizontally, 
(cond ; and O apart vertically, and 
((and (= 2 (abs (- X1 X2))) ; if cell between them is an obstacle 
(- 0 (- Y1 Y2))) >; or river, their children are in 
(cond ; different regions. 


({or (char-equal #\x (aref *cell* (/ (+ X1 X2) 2) Y1 2)) 
(char-equal fir (aref *cell* (/ (+ X1 X2) 2) Y1 2))) 
AE 
((and (0 (- X1 X2)) ; Same as above for 2 apart vertically 
(= 2 (abs (- Y1 Y2)))) ; and O apart horizontally. 
(cond 
((or (char-equal #\x (aref *cel1* X1 (/ (+ Y1 Y2) 2) 2)) 
(char-equal fir (aref *cell* X1 (/ (+ Y1 Y2) 2) 2))) 
pte) 
(t nil}?))})) 


n2 
E 
~~] 


.. oè 
£f! 


-*— 


Mode: 


LISP; 


Syntax: 


Common-Lisp; 


æ A 


Package: USER 


eA RARRHRRRRRKRERKRERRR AERA ERR ER RRR RNR RRR AERA RAEN ADE ORE Te UNUN 


 ARAARARARRARA RRA RA RARRARA RRA RA ARA RRA RARA RRA AAA AA RARA AAA RAR RA ARA AAA AAA AAA A 


o") & * * k 
r 
EK ORO 


<n eee 


AR ho 


^e ^e "e ^e 


found in file 


"opm.lisp" 


***** Current as of 7 Jun 89 


"utils.lisp" contains several utility functions used by "opm" 
and related functions. 


RAÁRAÁARARAARAAARARAR CAR AA RRARAA AR x00 oe ox ox 0x0 xx 0x Ax 0x0 A0x 0e eoe ox oe oe Ax Ax Ax 0 Àx4 9A Ax 0 Àx Àx 0 Àx A 9x Xx x x x Ax 


KAAR Arkka 


 RARRARARARRARARA RARA ARRRARARARRARRA RARA RRA RA RRA RARA RR RARA RARA RA RRA Ax A X A A 


;***** Function "on-line-incl-between" determines whether the first point 


ARR RK 
kk hh 


* o * x ox x* 


^e "eo "a 


2 Sih 


ii o 


(cond ((and 


is between the second and third, inclusive. 
Arguments: X & Y, X1 & Yl, X2 & Y2, coords of three points 
Returned: non-nil if (X,Y) is strictly btwn (X1,Y1) & (X2,Y2), 
or nil otherwise. 
Side Effects: none 
(defun on-line-incl-between (X Y X1 Y1 X2 Y2) 
(= X X1) (= Y Y1))) > TE. OT OO E 
((and (= X X2) (= Y Y2))) P AX, VR (X2, Y2), returna 
((and (or (« xl X X29 | If LOs eat 
(o 200 ; inside the rectangle 
tor (< YI Y Y2) ; formed by the line 
(EIA ; endpoints, check by 
(= {7 (= X) ; comparing slopes whether 
(- X X1)) ; point is on line. 
(cr x2) 
(DAI 
(land (= X Xl X2) ; If line is vertical, check by 
(or {< YIS?) ; comparing Y coordinates. 
> UNA ZA) 
((and (= Y Yl Y2) ; If line is horizontal, check by 
(o (< XIEX x2) ; comparing X, coordinates. 
(> X1 X X2)}))) 
(t-nil))) ; Else return NIL 


; 9 x X UR YUAN AUC AK CRONDRUONURER RUANDA "ED 


st ee ee 
OK RON mE 
oon 8 Ree 
oR ARES 
“Ss * 


ok kaa 
, 


(defun 


on di aK *k 
è 


Function "on-line-between" determines whether the first point 


is strictly between the second and third. 
Arguments: X 


Returned: 


ye 
non-nil if 


VISA 
(X, Y) 


or nil otherwise. 


Side Effects: 
on-line-between 
(cond 


none 
(x Y XII 2 


X2 kh X27 
is strictly btwn 


((and (or (« X1 X X2) : 
(» X1 X X2)) ; 
(or (curb Yo Y2) ; 
(2 XTECOY2)) : 
(= AZS YEN) E 
(SIRO ; 
Y (A 
(~ X TO 
( (and {= X X1 X2) Š 
(Or e YET) : 
(c EE T2) 
(land (= Y Yl Y2) F 
(or (< X1 XX2) ; 
CAIK KX?) 
epu 1) 


coords of three points 
(X1, Y1) 3800223209 


If (X, Yis strictly 
inside the rectangle 
formed by the line 
endpoints, check by 
comparing slopes whether 
point is on line. 


If line is vertical, check by 
comparing Y coordinates. 


If line is horizontal, check bw 
comparing X coordinates. 


: Else return NIL 


e e oe o fn CA AAA RARA A AR RARA RA ARA AAA AAA AA A AAA A AAA A AA RR CARR AR A AAC A RA) ARA ARCA RA 
t 


Function "magnify-pixel" takes a pair of pixel coordinates 


228 


MEE A^ and returns coordinates which are k times magnified. 


n et Argument: Pixel, a list of two numbers, and K, the magnification. 
> t Returned: a list of two numbers, each number 

ae being K times the original. 

aor Side Effects: none 


(defun magnify-pixel (Pixel) 
Mist maconitication* (first Pixel)) 
(* *magnification* (second Pixel)))) 


CRAM ARA ARA RARA AAA RRA RARA RRA RARA MA RAA RAR RR ARA AR AAA AA RARA A A A) e 
, 


pe **** Function "“magnify-pixel-list" takes a list of pixel coordinates 


ok and returns a list which is k times magnified. 

NAA Argument: Pixel-list, a list of lists of two numbers each, 
Bust ^* and K, the magnification. 

QAAE Returned: a list of lists of two numbers, each number 

aa kat being K times the original. 

eS Side Effects: none 


(defun magnify-pixel-list (Pixel-list) 
(cond ((null Pixel-list) nil) 
(t (cons (list (* *magnification* (first (first Pixel-list))) 
(* *magnification* (second (first Pixel-list)))) 
(magnify-pixel-lisşst (rest Pixel-list)))))) 


KARA AR RRA RAR MRAA RA AR RR RAA RA RRA RR ARA RARA RARA ARA RARA RRA RRA AA RR RAR ARA ARA A A 


***** Function get-backpath finds a cell's parent, and gives the 
NAAA pixels from the cell to the parent, including the cell. 
PAR hrs version only works for *magnif* - 2 or 3 
NE Argument: X & Y, coords of cell whose backpath is required 
NE "RBeturned:* a list of pixel coords 
MS Side Effects: none 
En AR 
(defun get-backpath (X Y 
n arent cell Xm Ym Xp Yp) 
(cond ((null (aref *cell* X Y 1)) nil) 
(t 

(setq Farent-cell (magnify-pixel (aref *cell* X Y 1))) 

(setq Xp (first Parent-cell)) 

(setq Yp (second Parent-cell)) 

(setq Xm (* *magnification* X)) 

(setq Ym (* *magnification* Y)) 

(list (list Xm Ym) 

(list (4 Xm (/ (- Xp Xm) *magnification*)) 
(+ Yn (/ (- Yp Ym) *magnification*))) 
aub Xm (> 2 (/ {= Xp Am) Pamaqnifticataon*)) ) 
(+ Ym (* 2 (/ (- Yp Ym) *magnification*)))))))) 


Leo Ye “e Yo Fe "e “Ye 


a ie eee ees ee Oe AK ARR RR ERE RK ERK ANHRARERER ARERR ERRAKRRKRKKKS A 


;***** Function get-all-backpaths finds the backpaths from every cell 
;***** on the map and puts them in pixel form into *backpath-pixel-list* 
(defun get-all-backpaths () 
(setq *backpath-pixel-1list* nil) 
toot 0 -Jg)y) 
C(strrng-equal "eof" (aref *mapline* J)) *backpath-pixel-list*) 
Inc Ei (11) )) 
((= (length (aref *mapline* 1)) I)) 
setas backpath—pixel—list * 
(append 
(get-backpath 1 1) 
*backpath-pixel-list*))))) 


$09 9 o À  À Kk o B o o ^ hh oA oh À 9 oh Oh À 9 à 9 AR B o Oh RA RAD RAD RADAR AAA RARER AeA RARHRARAAA AR AA HRA R 
? 


:***** Function set-equal checks if two sets are the same. 


TEREE Arguments: Setl and Set2, two lists treated as sets. 
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Ad is hen Returned: T if Setl and Set2 are the same, disregarding 
RARA repeated elements, NIL otherwise. 
(defun set-equal (Setl Set2) 
(cond ((and (subsetp Setl1 Set2) 
(subsetp Set2 Set1))) 
(t nil))) 


; NUN UU NU X UU Xx Uh xU UN CNN CNURORORCRCRCRORCRCKOROROR CROCO OR UK RONDE 


;S***** Function print-opl is a debugging function to print the OFL 


P***** Of a cell to the screen. 
(defun print-opl (X Y) 
(cond ((equal *goal* (list X Y))) 
(tt (print (arem *tcerl SEYN] 
(prinl (aref *cell* 
(first (aref *cell* X Y 3)) 
(second (aref *cell* X X 3)) 
2 
(print-opl (first (aref *cell* X X 3)) 
(second (aref *cell* X Y 3)))))) 


e EARRÁRARARAARA AA RA RARA RARA RA RARA RARA ARARRAAA AAA AAA UE 


;***** Function “linefeed" is a mnemonic for terpri. 
is Side Effects: causes a carriage return to be sent to 
EAS the output stream. 
(defun linefeed () 
(terpri)) 
(defun linefeed2 () 
(terpri *output=stream 0) 


;94 4 A AAA UNO IN ROCK OKNOKONONOROR OCA A RR RR DR ROREM 


2***** Function ""report-completion" sendsvcasmessagestosbtedsemc c 


(defun report-completion () 
(linefeed) 
(princ "Wavefront expansion complete") (linefeed) 
(princ "Type (kill-windows) to remove screen") (linefeed) 't) 


ARN AURORA RUN A CR OUR UAR hA OA OK CORDACRUNDR KADER ORDRE DENEN RE 


;***** Function sort-condition determines the order between 
O two cells on the wavefront. 
ARH Arguments: two sets of coordinates 


ORE Returned: TRUE if remaining cost of first cell is less than 


remaining cost of second. 
PON NUN Side Effects: none 
(defun sort-condition (Celli Celi2) 
(let ((X1 (first Celll)) 
(Yl (second Cell1l)) 
(X2 (first Cel112)) 
(Y2 (second Cell2))) 
(< (aret *cell* X1 Y1 0) 
(aref *cell* X2 Y2 0)))) 


eX Hh A ok k 
, 
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fee | Mode: LISP; Syntax: Common-Lisp; Package: 


USER -*- 


AI o X X A Ax A Ax An A n A X An An Xx A A A o o xà A A x X Ax 0 Àx& Ax Xx x o0 RU Àxà A x 0 ÀxA Ax x n0 0 Ax x 0x x 00x 00x x Mx Àx& Mx Ax RARAA A AAA A 


we 9.9 “e s 


RA AA A 


ED" Current as of 13 May 88 


ATARA 


=e "e "^. 


Yo 000 0 0 0 0 x0 à 0x 0&0 0 o o 0 x A000 00x x 0&0 Àx ÀxAG Ax 0 Àx 0 Àx& 0 Àx Ax4 x x 0 Àx& xà x x RARA AR RA AAA AAA A 
***** File "graphics" contains the functions to open a window for 
***** displaying the terrain, wavefront, boundaries, and back-paths. 
***** It is adapted from file "graph.lisp" written by Dr. Se-Hung Kwak 


BRE RONOROROR XAR AO CUR AGRAR RR NANI ÀÀ x 9»& A A 9A AG XA 


RRRARARARRA RARA RARA ARA A eU e he e e eh e UU 


(defvar *display-window*) 

(defvar *draw-window*) 

(defvar *draw-window-array*) 

(defvar *draw-window-width*) 

(defvar *draw-window-height*) 
(defvar *draw-window-inside-width*) 
(defvar *draw-window-inside-height*) 
(defvar *draw-window-position*) 


(defun initialize-graphics () 
(initialize-windows) 
(clear-window) 
(draw-goal) 
(draw-features *terrain-pixel-list*) 
(make-visible)) 


(defun draw-and-show-window () 
(mapcar 'draw-pt *boundary-pixel-list*) 
(mapcar 'draw-pt *backpath-pixel-list*) 
(make-visible) 
(setq *backpath-pixel-list* nil)) 


(defun draw-and-show-bdry-window () 
(clear-window) 
(draw-goal) 
(draw-features *terrain-pixel-list*) 
(mapcar 'draw-pt *boundary-pixel-list*) 
(make-visible)) 


(defun draw-and-show-backpaths () 
(clear-window) 
(draw-goal) 
(draw-features (get-all-backpaths) ) 
(make-visible) 
re) 


(defun show-boundary () 
(mapcar 'draw-pt *boundary-pixel-list*) 
(make-visible)'t) 


(defun show-terrain () 
(draw-features *terrain-pixel-list*) 
(make-visible) 't) 


(defun show-goal () 
(draw-goal) 
(make-visible) 't) 


(defun show-backpaths () 
(draw-features (get-all-backpaths)) 


(make-visible) 't) 


(defun initialàize-wincdows() 


(princ "Initializing Windows") (lLinefeed) (linefeed) 
(setf *draw-window-width* 650) 
(setf£ *draw-window-height* 500) 
(setf *draw-window-position* ’ (75 75)) 
(setf *display-window* 
(tv:make-window ‘tv:window 
:blinker-p nil 
:position *draw-window-position* 
¿width *draw-window-width* 
¿height *draw-window-height* 
¿name "display-window" 
:save-bits t 
expose prel) 
(setf *draw-window* 
(tv:make-window 'tv:window 
:blinker-p nil 
:position *draw-window-position* 
¿width *draw-window-width* 
¿height *draw-window-height* 
¿name "draw-window" 
:save-bits t 
¿expose-p nil)) 
(setf *draw-window-array* 
(send *draw-window* :bit-array)) 
(setf *draw-window-inside-height* 
(send *draw-window* :inside-height)) 
(setf *draw-window-inside-width* 
(send *draw-window* :inside-width))) 


(defun clear-window() 
(tv:sheet-force-access (*draw-window*) 
(send *draw-window* :refresh))) 


(defun draw-goal () 
(tv:sheet-force-access (*draw-window*) 
(send *draw-window* :draw-string "*" 
(- (* *magnification* (first *goal*)) 3) 
(+ (* *magnification* (second *goal*)) 5)))) 


(defun make-visible() 

(send *display-window* :bitblt 
tv:alu-seta 
*draw-window-inside-width* 
*draw-window-inside-height* 
*draw-window-array* 

202 0E 


(defun kill-windows() 
(send *display-window* :kill) 
(send *draw-window* :kill) 
(linefeed) (princ "Windows Killed") (linefeed) (linefeed) ) 


(defun draw-features (Fixel-list) 
(do ((Pest=of=-1list Fixel-LIYst Mrest rest or St 
((null Rest-of-list) ) 
(draw-pt (first Rest-ofr- I3 


(defun. draw-pt (point Coords) 
(tv:sheet-force-access (*draw-window?) 
(send *draw-window* 
:draw-point (first point-coords) (secondUPorntccocrdguD 


-*= Mode: LISP; Syntax: Common-Lisp; Package: USER -'*- i 
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***** marlotire;...sf > contazns Cne posStaci« anc one hiah-cost 
T EET rezlbn (1-2), with ezsge- and vertez-lists. 


a 


w, 


isetf *mapline* imare-array (list "nap-1engrn”))) 


(setf (aref *macline* l; *111221122211311211112211122:21112111111111 :121111111111222111122111:111112231131:12221180£221)31111232211]520500021: 0 0:17.00] 1] 0 0: 0 
(setf (aref *macline* 2)  7121121121122111:222:111212211::1111-111:121i: 1211111:2122221122113122:111:1152..12111221:21174.4: 512221122212 2:02 20:1] 35: E 
(seti (aref *macline* 2) Uu eon 121i11111211111!11111111:22:33121111131::3211331121211311.12:3111112:25113 210012211] ]0]] 1:05: 0110 000 0 (0 00 LL 
(setf (aref *macline* 4) “1112211122112 112211112211111:11111211111111111:2221121311111:21222711121313111:1111111222220215:321122121]212225.1 00021150 0 0 1 0] 0.0000 a£ 
(setf (aref *mapline* 5) du 1111:1211111:11111:1112111121i::22:111111221211122111111211111111122123211211131313223112 2. : 01 2] 01. 0008: 0 10:10:12 0 0 10 0 0 4 
(setf (aref *mapline* 6)  *111221222221221211111221:121121111111111111i1-21::1-- 112:1:211111111121131111211121322321:12:11211:1112:22122.2217]]0 010]: 2) 0 1] T 5 
istf varef *marline* 7)  *221223211221122212111211113112:231211111121232111312 eee 111:11212111212121211222.11121111152211...12]1252290312507:107.  J44 02 15 1015 00 10. 
(sect (ar@f *mapliney 8)  *1122222122212:1121111:122211121121. 11111211112222:1:1111221222111222121111111111:1112M 11210111 11 27.2.11] 01 1021 1.1 
isetf (aref *mapline" 9)  *1112i122:21112212:2111112121111:1122111111121;22::1-:1: 1112121111521 27 ls c NT I1l21l12l21212112212122212122212122.111221 11111122 2222222 
(setf (aref *mapline* 10) *11111122212122122111211111111111:11111221112;221122112112112:1111i111111111111211111211121111* 111212312:2212::211313111272:21: 152121. .:211] 1101101: 000. 
(setf (ares *mapline* 11) 7911121112:1211:11213111122311111121111131111111211323132111122132122-211121212]121 ada 21111111 pop de 211I oa E o TTE lIllilllilllh 
isetf (aref *mapline* 12) 9131232312223222:12212111212221112111121121121111111122;:231:1211112:12111i2121112112231113212112112112122222222121121]3 23310100 000. : 1100. 2 1L 11LLL 
(Setf (asdf *maplipDer 13) "1122:121:121312111:222112:2311321111121119 1121111111111111112:31111211211111:1112111221221121221211223123122222. 21112220270]. 2] 0] 95 2 012 0 1 0 111, LLL 
(setf (aref *mapline* 14) uMiiicllnilnninisiinnnunununrnindiini s cas eee caes 11121111212: :211]73, 211: 5102 11:.:11122i14:222 11 dee ie 
isetf (aref *mapline* 15) Qnpruuiiuininnnna es ndun MEE 2111111111111111131111112:11112112339312112272:2112222: 1122.21] ]]]] 1] 1 00 
(setf (aref *mapline* 16) 71111111111111 22111::1111122121111232221111321111213120] ee 211111111113111211121 21112:1112221212121 2:21 5.211]. 14 nnlli o 
isetf (aref *mapline* 17) “11122 PDL 11121111121111222:11111112111211123:1213111112121121111212111121221311312131112:21322::00]08 c] eee 
isetf (aref *mapline* 18) 71112:1212111111111112121111:221122111111211121212112111223221111111111111:111111221117 oe a ill. dla cir E LA A a 
(sett (aref *mabline* 19) 71112211121112111111111112111111112211 21111111211111111122:112:211113111111111121:1111221222321111221221:22211227222111] 10] )]] ] 2] 0] 0 1 
setí (aref *Dapline* 20) "111222211 A ee ee cid lil ee lIAinliNDDIDM»iNII11111II112l111lIIIilllll 1:222 
isetf (aref *mapline* 21) "1112111:22211111121222:21111111111111211121111:21:1- 11111221311121211121;11211121111:131:131232:121211]13111231:1: 11] 3:211] 00 22 501] 0] D doo 
(setf (aref *mapline* 22) "112221:22122121111111i1112:111111111111111112.2111122211..- 22:11211321111:1121111:21111112:12121i11121:31:::2::21]029 9102122: ee | er, 
isetf (aref *mapline”" 23) *1112211221112212211112111111:11121111121:1111121:22211111121112211111111? 2112111:221123122121121122122:22:: 21210] ee ca 
isetí laref *maoline” 24) "¡Amaia dd 2110111 1 dad 1311112211121 011011121012 11 1 U 10] 0 5 0 1 2221124211- N 
Herc. (aces “mabline*® AS ENN a a 211111:1111211211:12111111:1112111112:: 21111121111111.122122132.2200291010) ee 
iset (arek “mapiine* 26) "2211-551: :5232551121:11:112111111;1111 2522112 1211222221221211212122:211221121121121:111111:i312112:13123121:2232322 3112.2... 11] 2] 0] )] 1 000 0 0] | T 
setí (Stef *maplane* 27) "21112223121212.2.-.1112221111311121311132113.212211012211 2.03]: 00 01 da 5 111212121222111121:11251211131222112:112121.2 5.5. D] 104400 LE 
(isét* [argf *"mapline*w8) ZII- ane aee a a 11 c anauuusun uona n l c p fi 
(sett laref *mapline* 29) *2131222:222:222122211122.:11122121121311312.22123121112:2.)01]1 5] 22, 1:1] 22] 1 21] 2 04109 122112121212111111331:2222.22112:21]1291 21:121. :5:1]12: 1] ee 
wets lare! *mapline* 30) "i1222221111122212::111121211211111212111211111211:2::1122]11311]1211011221:131113171 1201:1233::03 898 30519 2121212:2:211111112::12312212 121 5:251) a D 
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(serí (aref "mapline” 150) er EI 211122111212121112111111112121.1121121::111 1 111 2 eee 
(setf (aref *mapline* 151) *eof”) 
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APPENDIX D - HIGH-COST EXTERIOR-GOAL HCA 
INTERIOR-BOUNDARY CONSTRUCTION SOURCE CODE 


eo NAR RKRRA KARA KAKA RAARAKAAKKAR AANA AKAAAKRAARARKAKKRERRAKKRARKKKARKR ARK A 


keke akan aR Ra Kaa RRA KR Ka aa eR tet et RK KKK KKK KKK AAA AA RARA AA AAA AAA AAA REA AAA ARA A A 
A 


Ele "bdrygen". 

5 Updated 12 Jan 89. 

* 

* This program generates boundaries for HCA interiors 

: tes them ta two files; "bdry out" is a file of prolog 
* facts recording the boundary and terrain information; 

x Poets rs the same info ready for plotting by the "figure" utility. 
NELPeuurres "bgmapdata", "bgutils", "bgplotter", and "bdryjoin" 

X to be in the same directory when started. 

Sage: from unix, type: 

2 prolog 

* [bdrygen]. 

t Dd. 

E halt. 

* 


RADA DC AAA A AAA ARA ARA A AAA ACA AA AAA RR A AAA A A RA RA A RA A CARR AA A RA AR RRA AA e RARA A AAA ARA A 


EA ARE RAE RARA RARA RARA AAA RARA RARA AA RAR RARA RARA RARA AAA RARA RARA ARA A X x x à à / 


bg :- Bcoenpüiusptevflag(write]), D'NorgoupyUeEtlacinoewrate)) 5 
»notialrze bg, 
generate burys, 
Save (bastate), 
tell(user),nl,write(’ Boundary generation done (First Pass)’),nl,nl, 
reconsult (bdryjoin), 
bary )jorm. 


B - generate bdrys, 
tell (user),write(’ Boundary generation done (Second Pass)'),nl, 
Bury join. 


Hu rategbdryo :- 
goal point (Xg,Yg), 
M gdongvcrbucesC [XI TPTX?,Y2[RListl]), 
EIU SIX Y2UREBISUtI),[X1,YI],RList2), 
iEngbdiosEput(iXg,Yg],RList2, 7*9 
classify edges(PList2,|Xa, Ya), RList3), 
Comvert vilist to elist (1,PlList3, WNSIE 4), 
as=sart (region elist(RList4)), 
generate boundariesO0 (RList4, [Xg,Ya]), 


Sedemeimitbdry indices, !. 
/* 
*  Temporarily, file "bgmapdata" must have a8 predicate for each 
* vertex with its optimal path list. Eventually, this should be 


* weplaced by a call to a path-finding program such as "sls" or: "riri" 


E 


compares lot. edge w/ 2d,3d.., recutse to comp 2d edge w/ 3d,4th..,etc*/ 
uEncratesboundaries0([X1,Y1,V12,H12,xX2,Y21], [Xa, Yq]) . 
generate boundariesO([X1,Y1,V12,H12,X2, Y21 Rest] , (Xa, Ya)) .- 

oeme aeee aa ES [X1], Y1, VPI, X2, Y2 [Pe3t]; |Xg, Ygl)., 

gen® rate. boundangwes) (Rest, xg7Yg]). 


opina condition: only cue PAE MRE *7 


pEECCautesboonunderves(l s». 6 rv-—be Lanes) ict. 


/* If vertex list from fW "bamajdata" already include the */ 
/* first point as tbe last, jit will appear twice, so ignore  */ 
/* the second occurence. */ 


A Uca esa, Wa, , ,Xbl,Yl,Xa,Ya, , ,53b,Yb],l| , |j) :- '. 


[+ Type la 

generate boundaries ([Xa, Ya, v,Nab, Xb, Yb, Xc, Yc, v,Ncd, Xd, Yd|Rest], (Xg,Yg]) :- 
interior cost (Cil er erior cost (Cel; /* 2vis (Typel) -bdrm 
plot 2vis bdry (Ci,Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd) , /*plot Edgel,E2*/ 
generate boundaries((Xa,Ya,v,Nab,Xb,Yb|Rest], (Xg,Yg]). /*(E1,E3|Rest)*/ 


/* Type 2 */ 

generate boundaries([Xa,Ya,v,Nab, Xb, Yb, Xc, Yc, h(F) , Ned, Xd, Yd| Rest], [Xg, Yg]) :- 
interior cost (Ci) exterior code (eer /* 1vis (Type r Ei 
plot lvis bdry(F,Ci,Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd), /*plot El, E224. 
generate boundaries ((Xa, Ya, v, Nab, Xb, Yb| Rest), {(Xg,¥g))-. /*[EI,E3IRest] *7 


/* Types 3 and 4 */ 

generate boundaries([Xa,Ya,h(F) , Nab, Xb, Yb, Xc, Yc, h(G) , Ncd, Xd, Yd| Rest], [Xg, Yg]) :- 
interior cost (Ci), exteriori o Eac /* Ovis (Type 3 or UI 
plot_Ovis bdry(F,G,Ci,Ce,Xa, Ya, Nab, Xb, Yb, Xc, Ye, Ned, Xd, Xd), 1 plot il 
generate boundaries((Xa,Ya,h(F),Nab,Xb, Yb|Rest], [Xg,Yg]). /*(El,E3|R]*7 


inaitaalrzegbqe 
consult (bgmapdata), 
consult (bgutils), 
consult (baplotter), 
tell (user) nl, nl, ni, 
write('Boundaries being computed:'),n1,!. 


initial output ([Xg,; Yg], Region, Regienke Prai ia 
assertz(title('')), 
title(Title), 
write to bdry  file(tCit renier 
write to bdry' file(goal [Xantal]; 
write to bdry file{(region, Regioni 
/* write to bdry file(region eelist kegi onne imati 
write to fig frle(tat leig 
write to fig file(goa mixin gin, 
write heading(region), 
write to fig file(region Tegi on yaa 
! 


/* convert list of vertices (vertices are not repeated) to a list 
* of edges (a vertex appears once for each edge) 
* Also number the edges sequentially, and assert the number of edges. 
t 
convert vlist to elist (N, [X1, Y1, V1, X2, Y2] UI IU M 
assert (number of edges(N)). 
convert vlist to elist(N,TlXlI,Y1l.,o,X2, Y2UBDOUSERCSDIB 
 (X1,Y1,0,0,X2,Y2|RevRListRest]) :- 
convert vlist to elist(N,[X2,Y2|RListRest],RevRLUvSthReSt) s !. 
convert _vlist tofelastan {XI YI Vi X2 YZ Stu 
[X1,Y1,V1,N,X2,Y2|RevRListRest]) :- 
Nplusl is N + 1, 
convert vlist to elist(Hprusi [X2,Y2|RDisStRest) bean tose e jee 


classify edges (LUI a IS 
edge. visibility check (C2319 CF 
rotate edgar e 
mark edges(L3,L4), 
insert oppossuecprib4 U3), 
remark edges uo) l. 


/* First step past vis edges, leaving their markings unchanged */ 

remark edges([Xl,Y],v,X2,Y2Z[Rest], [XT YI^ v X2 DERE 
remark edges([X2,Y2|Rest], [32, Y 2] pe 3E] 

/* How step past h(b) edges. */ 

remark edges([X1,Yl1,h(b);X2,Y2]|]Rest], [XE YI DEDE 
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remark edges ([*Z,YZ{Rest],([X2,¥2Z{Rest2)) . 

/* At each h(ob) edge, change 'ob' to 'b' */ 

remark edges((Xl,Y1,h(ob),X2,Y2|Rest], (X1, Y1, h (b) , X2, Y2j] Rest2]) :- 
remark edges((X2,¥2iRest |i x21 2|Regt 2) ) . 

/* At each h(oa) edge, change 'oa' to 'a' */ 

remark edges([X1,Yl,h(oa),X2,Y2|Rest]), [X1, Y1,h (a) , X2, Y2| Rest2]) :- 
pemarkEedses([32,Y2|Restl 5 [X2; Y2|Resc2]) . 

/* At first h(a) edge, stop. */ 

Hemarkedges([X1,Y1,h(a) ,X2,Y2|Rest], (X1,Y1,h(a),X2,Y2|Rest]). 

/* If no h(a) edges, stop. */ 

noemark edges([X,Y], [X, Y]). 


maert opposite pt (L4,L5) :- /* On first pass, assume no shortcutting */ 
Hot first pass.done), /* occurs and set up opposite point */ 
insert tentative opp pt(L4,L5), /* and optimal paths accordingly. i. 
assert pseudo ops (L5), e 

insert opposite pt(L4,L5) :- /* On second pass, use correct opp point */ 


first pass done, 
EnSertScorrect opp pt(L4,L5), tf. 


/* On FIRST PASS, insert tentative opposite point at the midpoint of */ 
/* the opposite edges, disregarding any possible shortcutting. */ 
/* Change marking on other 'o' edges accordingly. */ 
/* First step past vis edges, leaving their markings unchanged */ 
EnMcstEtentative opp pt([X1,Y1,v,X2,Y2j|Rest], [X1, Y1, v, X2, Y2|] Rest2]) :- 
znsert tentative opp pt([X2,Y2|Rest], [X2, Y2|] Rest2]) . 
/* Now step past h(b) edges. */ 
NUECUUEbentative opp pt([Xl,Yl,h(b),Xx2,Y2|Rest], [X1,Y1,h(b),X2,v2|Rest2]) :- 
mmsert tentative opp pt ([X2,Y2|Rest], [X2,Y2]|Rest2])}). 
/* At first h(o) edge, branch to insert..2, passing opp edge info along. */ 
NEuECnEtentative opp pt([X1,Y1,h(o),X2,Y2|Rest],RevisedL) :- 
optimal o path([X1,Y1|]OF1],Cccw), 
insert tentative opp pt2([X1,Y1,h(o),X2,X2|Rest)s [X1, Y1], Cccw, RevisedL). 
/* If there is no h(a) edge, go to insert..3, then stop at last h(o) edge */ 
/* opposite point in previous 'o' edges. */ 
EuscsrEtentative opp pt2((X1,Y1,h(o0),X2,Y2], OB, Ceocw, R2) :- 
EuScHtEtoHutative opp pt3sebxe,Y2, [X2, Y2, b(o) | OE] ,Cccon, R2). 
/* At each h(o) edge, pass opp edge info along. */ 
Ent stentative opp pt2([X1,Y1,h(o),X2,Y2|R],OBE,Cccw,R2) :- 
mert tentative opp pt2([1X2,Y2/R], [X2,Y12,h (o) I1OE], Cccw, R2) . 
/* At first h(a) edge, insert lst-guess opposite pt in previous 'o' edges. */ 
EX EEtentative opp pt2([X1,Y1,h(a),X2, Y2| RB], OE, Cecw,OandAList) :- 
optimal path([X1,v1|OPcw],Cocw), 
uovergesedge 1istCETOERev), 
ctugesrengc(OERev,LengEh); 
D is (Length+Ccw-Cccw)/2, /* opp pt is D along the OEs ccw from ptl */ 
insert tent opp pt along edges (OERev,D,OERevised), 
cons (OERevised, [h(a),X2,Y2jR]),OandAList). 
/* If there are no h(a) edges, insert lst-guess opp pt in previous 'o' edges. */ 
meere tentative opp pt3 (X11, Y¥1,O0E,Ccew, OandAList) :- 
optimal path([X1,Y1|OPcw],Ccw), 
ncucrnogcscuge 1rst(OB,OERev), 
edge length (OERev,Lenath), 
D is (LengthiCcw-Cccw)/2, /* app PE i3 D along the OEs ccw from ptl */ 
insert tent_opp_pt_along edges (OERev,D,OandAList). 


IU ent iopp. pt along edges((X1,Y1,h(0),X2,Y2/0E],D, [X1,Y1,h(ob) JOERev)) :- 
^ distance(X1,Y1,X2,Y2,D1), D2 is D - Dl, 
ZAS O. 
meert tent opp pt along edges ({[X2, Y2[0E], D2, 0ERev). 
woeri tent opp pt along edges ([X1,Y1,;bh (0), X2,Y2|0E] D; 
Hi (OD xopp: Yopp, h (oa) | OBRe v] ). uz 
dist ance {Al Y1, X2, 2,01), D2 is D - Dig 
px 0 
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DelX is X2 = KijePely is YZ =e 
Xopp is X1 * DelX*(D/D1), Yopp is Y1 + DelY*(D/D1), 
assert (opposite point (Xopp, Yopp)), 
change 0 to _ oa([(X2, Y2|OEJ,OERev). 


change o to ea({x, Yl, (7 eee a 

change o to oa((X1,Y1,h(a),X2,Y2|OE], (X1,¥1,h(a),X2,Y2|OF)) :- n 

change o to oa([X1, Yl,h(0) , X2, Y2]OE], [X1, Yl, h (oa) , X2, Y2| OERev]) r= 
change_o_to_oa([X2,Y2|0E), {X2,Y2|OERev]), Le 


/* At each vertex along tentative opposite-edge sequence, assert a */ 
/* pseudo-optimal-path as if no shortcutting occurred */ 
/* First step past visible edges */ 
assert pseudo ops([X1,Yl,v,X2,Y2 [Res n 
assert pseudo ops([X2,Y2]|Rest]y. 
/* Now step past 'before' edges */ 
assert pseudo op3([X1, YI nib) 427 ce 
assert pseudo ops Ac |RBesmM 
/* At first ‘opposite’ edge */ 
assert pseudo ops ([X1, Yl, Ntopm x2, 12\ Rest) je = 
optimal path ATEO” 
assert (pseudo optimal path([X1,Y1|OP1])), 
exterior cost (Cer 
assert (pseudo optimal path([X2,Y2,c(Ce) , X1, Y1|OP1])), 
assert pseudo ops2([X2,YZ|Restdh. 
/* At subsequent ‘opposite’ edges */ 
assert pseudo ops2 ((X1,Y1, (obj) 22 X? Rest) = 
not (opposite point (X xi: 
pseudo optimal path([{X1,Y1|OF1)), 
exteriores tico)” 
assert (pseudo optimal path([X2,Y2,c(Ce),X1,Y1|OP1))), 
assert pseudo ops2([X2,Y2|Rest]) . 
/* At edge with 'opposite point' */ 
assert pseudo ops2(t[XI7YT1;h(coa) X2 eee 
opposite point (X1, xim 
assert pseudo op33 (A m Een 
pseudo optimal path([X2,Y2{OP2]), 
exterrorf Cost (CSIR 
assert(pseudo optimal path((X1,Y1,c(Ce),X2, Y2|]OP2])) . 
/* If there are no 'a' edges, assert clockwise OP at vertex and stop. */ 
assert pseudoXopsj Q[X 
optimal path px Y ORNE 
assert(pseudo optimal path((X1,Y1]|OF1])). 
/* Search to end of ‘0’ edges, asserting clockwise OP at each cw vertex */ 
assert pseudcoseps3 (XI YI dtoal x2 Nc 
assertipseudo 0ps9 ( [2/12 1Re Sci 
pseudo optimal path((X2,Y2/|0P2]), 
ẹxterior cost (ee), 
assert (pseudo optimal path{[X1, Y1, c (Ce) X2, Y2 P: 
/* At first ‘after’ edge assert a cw ps-op and stop. */ 
assert pseudo ops3((e)7 11,ntajle 42, IR SS 
optimal path YIJObl 
assert (pseudo optimal path([X1,Y1|JOP1])). 


/* On SECOND PASS, insert correct opposite point into the f 

/* the opposite edges, disregarding any possible shortcutting. */ 

/* Change marking on other 'o' edges accordingly. */ 

/* First step past vis edges, leaving their markings unchanged */ 

insert correct opp pt([X1,Yl,v,x2,Y2|Re SEITEN EUN SED 
insert correct, opp pt ([%2, YZ2| Pes UMEE ST ZUM 

/* Now step past h(b) edges. */ 

insert correct opp _pt(([X1,Y1,h(b) ,%2,%2 || Restle wien, Yc pest 
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insert correct opp pt([X2,Y2|Rest], [X2, Y2|] Rest2]) . 
/* At each h(o) edge, see if opp pt is on this edge. P 
/* If so, revise rest of h(o) edges and insert opp pt. i 
insert correct opp pt([X1,Y1,h(o),X2,Y2|Rest], 
[X1,Y1,h(ob),Xopp,Yopp,h(0oa),X2,Y2|Rest2]) :- 
opposite point (Xopp, Yopp), 
on_line(Xopp, Yopp,X1,Y1,X2,Y2), 
change 0 to oa([X2,Y2|Rest], [X2, Y2|Rest2]), Ó. 
/* Yf not, mark edge h(ob) and look at rest of h(o) edges. */ 
EusErtScorrect opp pt([X1,Y1,h(o),X2,Y2|Rest], (X1, Y1l,h (ob) , X2, Y2| Rest2]) e 
insert correct opp pt((X2,Y2|Rest], (X2, Y21Rest2]) . 


/* Step thru edge-list, rotating it until all visible edges are on its  */ 


/* front, and all hidden edges are on its end. ny 
/* Upon finding a hidden edge before any vis edge, put it on the end, n 
/* and start again looking for vis or hidden edges. Ty 


pomate-edge list([Xl,Y1l,h,x2,Y2|Rest], RevisedList) 
cons([X2, Y2|Rest], [h,X2,Y2],L2}, 
rotate edge list(L2,RevisedList), le 

/* Upon finding first vis edge, step thru the list keeping vis edges in */ 


ee 
| 


/* order, and then keeping hidden edges in order. If any vis edges are */ 
/* on the end of the list, put them on the front. a 
/* and if so, put them on the front, maintaining order. A 


nrcexedge list([X7Y,v|Rest],FullReviSedList) :- 
motate edge list2([X,Y,v|Rest],RevisedList,FrontofList), 
cons (FrontofList, RevisedList,FullRevisedList), !. 
/* Go past the front-end visible edges. */ 
eme dge Jist2([X1,Y1,v,X2, Y2| Rest], [X1, Yl,v|DL2],FrontofList) :- 
porpatesedgeclI32st2T7[x2,Y2Z[|Rest],bL2,Frontofbist), !. 
/* Go past the first hidden edge after the visible edges. */ 
I s-dgeslis5t2([X1,YLI,h,X2,Y2|Rest], [X1, Y1, hl 52], FrontofList) :- 
Dotate edge list3([Xx2,Y2/Rest],L2,FrontofList), l. 
/* Go past the rest of the hidden edges after the visible edges. */ 
meee edge list3i[(X1, YI h?X2, 12 [Rest], (X1,Y1,h/L2], FrontofList) a 
rotate edge list3([X2,Y2|Rest],L2,FrontofList), !. 
/* If visible edges are found past the hidden edges, the rest will also */ 
/* be visible; send the rest back up to be put on the front of the list */ 
meate edge list3([X,Y,v|Rest], [X, Y], FrontofList) :- 
butt st coords ([X, Y, v|Rest],Frontoftist, !. 
/t Ending condition. */ 
eate edge list3([X,Y], [X,Y], []) :- !. 


/* eliminate the last coordinates and the last edge-vis flag */ 
Piemonte last coords({X,Y],(]}).- 
all but Piast B cords r V|Rest]; [X, Y, V |RevisedResti): 

all but last coords (Rest, RevisedRest). 


/* mark edges before (b), after (a), or opposite (o), based on whether */ 
/* they are before or after the opposite edge, or undetermined. */ 
mare redges (Ll, L3) :- 

cas LI L2) mark edges3 (L2 L3), assert opposite edge (L3). 
EN 'mark edges2' marks hb)” or 'h(a)' based on opt paths of edge itself. */ 
E cccocasase for 'mark edges2'. */ 
mresedges2zt[., l.l , ]). 
/* First step past vis edges, leaving their markings unchanged */ 
nxmeuges20[x151;v.x2 Y2|BRest],|X1,Yl,v,X2,vYx2|Rest21]) :- 

mark edges: (X2 x2] Rest], (X2, Y2| Rest 2].) . 
AU pon finding a hidden edge, check if it is b’ or 'a' or 'o' */ 


Is bp if Opt path from X2,Y2 starts toward X1,Yl. e 
pe dgess 21,11, b, 2, 12|Rest], [X1,Y1,b(b),X2, Y2]Rest2]) :- 
Speimalypath({xX2, %2,0(C),X1,¥11_)]), 


Umea (tee ko, Xe, kl, Y 1), 
marte cages (2, Y2 |Rest], [X2,Y2]Rest2])?. 
IAS a ilL opt path from X1,Yl starts toward X2,Y2. wi à 
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mark edges2((X1,Y],h,%2, ¥20 Rest e SS 
— optimal path (XI MIC AA 
on ray (Xi, Yi, XI VE 
mark edges2([X2,Y2|Rest], [X2, Y2| Rest2]) . 
/* Otherwise it is potentially an opposite edge, so mark it with 'o' ^*/ 
mark edges2([X1,Y1,h,X2,Y2|ReSt), [Xt1,Yl;h(OD x22 v2]Best^ M 
| A mark edgea32([|X2,Y2|Rest], [X2, Y2| Rest2]) . 


/* mark edges3 marks 'b' or 'a' based on previous marking of adjacent edges. */ 
/* First step past vis edges, leaving their markings unchanged */ 
maxk edges3([X1,¥1,v,%2,%2}] Rest |) [21 A 2 ede) 
mark edges3([X2, Y2 |Rest] P [X2; Yk eate E 

/* Now deal with hidden edges. */ 
mark edges3({[X1, Y1, H1, X2, Y2|Rest] {XI Y H? TA ec) ee 

| mark edges4([X1, Y1, H1, X2, Y2] Rest (x1, ri H2 X2 EE 
/* Base case $l. End of list. */ 
mark edges4([5 X], ToS 
/* Base case #2. Unknown, or as previously marked. */ 
mark edges9(1X1,Y1,H 2 12 IRA, LO cg 


/* Base case #3. It is 'b' if next edge is already 'b'. x 
mark edges4([X1,Y1,h(0),X2, Y2, h (D) , X3, Y3], [X1, Y1,h (b) , X2, Y2, h (b) , X3, Y3]) . 
/* Base case #4. It is 'a' if previous edge is already ‘a’. E 


mark edges4([X1,Y1l,h(a),X2,Y2,;h(o); X3, Y 3]! qo Y 1 A | 

/* Base case #5. It is still potentially an opp edge, as previously marked. */ 

mark edges4([X1,Y1,H0, X2, Y2, H1, X3, 3], (X1, Y1, H0, X2, Y2, H1, X3, Y3]) . 

/* It is 'b' if next edge is already 'b'. oie 

mark edges4([Xl, Yl, h{(o),X%2,¥2,h(B);, X37 RSE] 
[X1,Y1,h(b) ;-X2,¥2, nb) S237 73) Resi pee 
mark edges4 ([X2, ¥2,h(b) 9x3, 73 (Rese, (27 2 noe ie este 

/* It is ‘a’ if previous edge is already 'a'. n 

mark edqges4([X1, Y1, h(a), X2, Y2 ho) xs ee ee 
(X1,Y1,h(a),X2,Y2,h(a),X3,Y3|Rest2]) :- 
mark edges4([X2,Y2,h(a) , X3, Y3|] ReSCUD UD x2Z OY ZUR DEDE ITO DRE SEPIUS 

/* Otherwise it may be an opposite edge, so leave it as previously marked. 7 

mark edges4({X1,¥1,H0O,X2, ¥2, 01, X37 13 Resell, Vl, Oy NIHU SPESE eee 
mark edges4 (([X2Z, ¥2, Hie IS Resto a HE RES e 


/* First step past vis edges */ 
assert_opposite edge ({X1, 1], V X2 Y?|Re < E 
assert opposite edge([X2, Y2 |P cS NDE 
/* Second step past h(b) edges */ 
assert opposite edge([XI1,Yl,hí(b),X2, Y2|[Rest]) :- 
assert opposite edge, 12 estilos 
/* At first opposite edge, get rest of opp edge and then assert info */ 
assert opposite edge [UE DTO AS CS 
assert_ opposite _edge2([(X2,Y2|Rest],Rest2), 
assext (opposite edge (1x1 1 ore am 
/* At first h(a) “edge mor at ento rs S xy 
assert opposyitesedgs um M D 
assert opposite edge20 a A ANA 
/* At each h(o) edge, get rest and send back opp edge vertices */ 
assert opposite edge2(0[XT Yr,h(o);X2.,Y2TRe St] odo DIDI ese |) 
assSertooppesxeesedge20[22,Y2!Rest]oReSst? MI 


[3 86 6 AAA AAA AAA DAA AREA AAA AA AAA REA AN ee oA AON CA CENE 


/* Succeeds if lst pt is on a ray from 2adepte to Jrd pumbet teen sehen tivo pro PER 
/* & fails o/w. Succeeds if lst pt = 3rd pt, Lails ISDEM ND PE 
On ray (AZ, Yayo ee ee 
On ray (Xi Yi ee 
strictly between(íXi,XI,X2), 
strictly- betreenili i L Y7); 
yx is Xi*(Y2-Y1)/(x2-X1) + Y2 =- x2" 02 7 AM PE P 
within ealerancen imis, yi, Yi); 


242 


/* Binds UL to the list of opposite edges. */ 

ASEO edges (I 7-h(v) (R),U0L) :- o edges(R, UL). 

get, oO edges(| , ,h(b)IRJ,UL) :- o edges(R, UL). 

Beene eCdges(([X1l,Y¥1l,h(o),X2,Y2|R), {X1, 71, X2, Y2|RestuhL]) 
gGemuomeoeages (|X2,712|/R)],Reseuby: 

memo edges (2 HA (a) [R] fI} :- get _o edges(R,[)). 

Bopreo edges([ , J,[]). 


erder initbdry indices :- 
retract (initbdry({1I,J),B)), 
Sort (12,d2)); 
asserta(initbdry({I,J],B)), 
tall, |. 

ceder cinitbdry indices :- !. 


243 


JAARRARARARARARA RAR RA AAA RAR RARA RARA RARA RAR AAA AA A A ADAE 


ARERARARAARARA RRA RARA RARA ARA ARA RRA RARA AAA RA RARA ARA ARA AAA ARA ARA ARA A A 


File "bgplotter" has the predicates which plot 
boundaries of various types. It is loaded by "bg". 


d eoo An ox x AR RARA RARA AAA RAR AAA AAA ARA RRA AAA AA RARA AAA AAA AAA AA RAR RA 


Coe e he e e e e e e e e ARA RARA RARA RARA RARA RRA RARA RR ARA RRA RRA ARA RARA RARAS 


fh kk kho k AAA ARA RRA AA ARA AAA AA RARA AA RN ONU OK NOR ON OK OK RU ee ee 
* This predic. plots 2vis/ (Type 1) boundaries between two HCA edges, ie, 
* between two visible edges 

* 

* Updated 12 Jan 89. 

* 

* 

t Ci; interior (hagh)m eost 

* Ce : exterior (low) cost pec 

* Alpha : included angle of X 

a region vertex N 

* Beta : angle between first X High-Cost Area 

$ edge (pt V to pt A) and x Interior, cost = Ci 
A a line between the S 

* vertex and the goal. A 

* Gamma : angle between second X 

* edge (pt V to pt C) and N 

* a line between the X 

x vertex and the goal. \Alpha 

* Di : distance from goal to vertex. Gamma x 

* RotAngle : angle needed to rotate pt V pt 
x the x-axis counterclockwise / Beta 

x to bring it parallel with : 

$ the first edge (V to A) z Exterior, 
* Xa, Ya : coords of frrESESporHES : cost = Ce 
* Xv, Yv : coords of second point, / 

^ the vertex, connected to pt A xt 

a XC, YC 3; COOLds OM o nee Goal 

* Xv2,Yv2 : if the edges are not 

* connected, these are the Here the rotation angle - O0. 

X coords of the "inner" vertex 

a of the second edge, of which 

: pt C is the other vertex. 

ts 


plot ¢2vis_ bdry (C1, Ce, Aa, Ya, Nab, Xb, vb, ke eed. 4, ica — 

virtual vertex (Xa, Ya,xkb, Yb, Xe, 1c, <a, rd, Avvo), 

plot 2vis_ bdry ai leases (G37 Ce, Nab, Ned, Xa, Yay %yy, iv, 44,10) 1. 
plot_2vis bdry allcases(Ci, Ce, N1, N2, Xa, ya, Xv, Yy cm 


Phat ia lize ee mle, A TSn a 2v/ oras 
goal point (Xg,Yg), /* Type 1 boundary. */ 
pid eae 


distance (Xv, Yv, Xg, Yg,D1), 

distance (Xu, Y, xc, Ye 2) 

distance (Xa, Ya,Xv,Y¥v,D3), 

distance (Xa, Ya, Xc, Yc,D4), 

distance (Xa, Ya,Xg, Yg,DS), 

not (D1=0) , not (D2=0) , not (D3=0), /* If any of these fail, */ 
not (D4=0),not (D5=0), /* => programming error or map error */ 
Cosi is (D2521pJ^2-D4^2)/ (2*D2*03)50 

arccos (Cosi 7Aipha), 

Cos2 15s (DI ADP 2 DS ?2)/ (2° DI DF 

arccos (Cos2, Beta), 

Gamma is 2*Fi - Alpha - Beta, 
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ThetaCrit is asin(Ce/Ci), 


tell(user), write('2vis (Type 1) bdry being plotted between edges 


write (N1),write(’ and '),write(N2),nl, 

check input for typel (Alpha, Beta, Gamma, ThetaCrit,Dl), 
compute angle of rotation(Xv, Yv,Xa, Ya, RotAngle), 
assert (bdry([Xv,Yv])), 


calc bdry typel(Alpha,Beta,Gamma, ThetaCrit,D1,Xa,Ya,Xv,Yv,Xc,Yc), 


rotate bdry(RotAngle), 

bdry (Bdry), 

reverse path list (Bdry,RevBdry), 
truncate off map (RevBdry,FinalBdry), 
assert (initbdry ({N1,N2),FinalBdry)), 
PoecetINbdry out), orite Type 1l *),nl, 
write to bdry file (bdry,Bdry,N1,N2),nl, 
cutput to figure file, */ 

i 


-re -e æ = eS OO UA M 


Eutgjalrze for bl :- 
abolish(done,0), 
abolish(bdry, 1), 
abolish(thetal,1), !. 


Eucabdryctypel(A,B,G,Tc,D1,Xa,Ya,Xv,Yv,Xc,Yc) :- 
pi(Pi), 
get T1 range(G,Xv,Yv,Xc,Yc, Tlmin,Tlmax), 
precision(Precision), 
DelTl is (Tlmax-Tlmin)/(Frecision/2), 


Tlinit is Tlmin - DelT1/2, /* let lst point be closer to vertex 


assert (thetal (Tlinit)), 

retract (thetal (Tlprev)), 

Tl is Tlprev t DelTl, 

Tl < Tlmax+0.01, 

a EZ, 

assert (thetal(T1)), 
ESICEbUdEVUDSptiDI,TlI,A,B,G,TC,T3,T4,Y1,Y2), 
EHEcccuovrSSMresults(-IS,-T4,Y1,Y2,B,DI,Xv,Yv), 
done, 1. 


dm è ë m A ee 


Garemedry! pt (D1l,1T1,A,B,G,Tc, 
Ope on vel. Y 2) t= 
abolish(done1,0), 
abolish(theta3,1), 
abolish(increment,1), 
Pi(Fi), 
iretrner is —(Fi-B) /2, /* 1/2 of range of Theta3 */ 
assert (increment (InitIncr)}, 
DGIDnitsTSB-(P1/2), 
assert (theta3 (T3init)), 
retract (theta3(T3)), 
calme Sutton (Dl, T1,A, B,G6, Te, T3,T14,Y1,Y2,£), 
dama cection (E, Direction), 
uo newübrrection,T3,T3new,Inctr), 
assert (theta3 (T3new)), 
donel, !. 


ie tec (11, Yl, X2,Y2,X3,13,X9,Y4,Xv,Yv) :- /* the virtual vertex 


J; 


oa: 


PA 


ep re rpsectioniXl,11,42,Y2X3,Y13,X9,Y9 449 Xv) 1 > ¡EL Count of *J/ 
/* intersection of the lines. */ 


a ranas Y, e, Ye, Tlinit,Tlfinal) :- 


to 
x 
TAN 


Tlinit-is C-E? 

goal point (Xg,Yg), 
distance (Xg, Yg: Xy, v DI); 
distance (Xc, Ye, %v,17 pa) 

distance (Xg,Yg,Xc,YoWb3), 

Cos is (D2^2+D3^2-D1^2)/(2*D2*D3), 
arccos (Cos, Angle 

get_Tifinal (Angle,Tifinal), !. 


get Tbfxnal(hngle, Tbfrng ee 
Anglé > 0705; 
Pith i), 
Tifinal is Pi/2 - Angle, !. 
get Tifinal (Angle, Tifinal) ES /* Make Thetal a little larger */ 
Angle =< 0.05, 
pi(Pi), 
Tifinal iə ((Pi/2 - Angle)+(Pi/2))/2, !. 


get direction minus). > 
E >O 00L 
get direction(E, plus) :- 
B E < -0.001,!. 
get direction dono 
assert (donel), !. 


get TJnew(donc Da NM ee 
get T3Jnew(plusjDS Douce ner) ie 
increment (Incr), 


Incr <07 /* If ditrection cf search */ 
T3new is T3-Incr, /* has changed, halve the */ 
Halflncr is -Incr/2, /* incr & change signs, i 
retract (incrementi )}, /* otherwise don’t. x 


assert (increment (HalfIncr)), !. 
get T3new (plus, 13) 7 2new, incr ee 
retract (increment (Incr)), 
T3new is T3+t+Incr, 
assert (increment (Incr)), !. 
get T2new (minus, 02) t2neu ieee: — 


increment (Incr), /* If direction of search */ 
incre po. /* has changed, halve the */ 
T3new is T3-Incr, /* incr & change signs, x 
Halflncr is -Incr/2, /* otherwise don't. 2 
retract (incrementi MIs 


assert (increment (HalfIncr)), !. 
get_T3Inew (minos IIS e Ec TUM 

retract (increment (Incr)), 

T3new 13 13) ines, 

assert (increment (Incr)), !. 


calc Epsilon(DI, TI, AB C be, te, hoe eee 
T2 is asin(sin(Tc)*sin(T1)), 
TÀ is asin(sin(Tc)*sin(T3)), 
SinTc is sin(Tc), 
Xl is Di*sin(G})}/cos(T1), 
Yl is Dl*sin(B)/cos(T3), 
Al is Dl*sin(A)/cos(T2), 
A2 is Di*sin(A)/cos(T4), 
Bl is cos(Tl-G)/cos(Tl), 
B2 is cos(T2+A)/cos(T2), 
B3 38s cos(T3-B7cosatr3). 
R4 is cos(T44A) /cos (T4), 
X2 19 A1*(B3-B1*B4)/(1-B2*B4), 
Y2 is A2*Bl-(X2*cos(I21A)/cos(T4)), 
Lis 19 Sinte*x 7 
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Rhs is SinTc*Y1 4 Y2, 
EXrSUObhs-his, t. IESO if costiX-path) » Cost(Y-patb) */ 


check input for typel(A,B,G,Tc,D1l) :- 
Patel), 
A20 20 A « Pi, 
B > Pi-A, B < Pi, 
Ge bien. G «e Fi, 
Te > 0, 
DEE, 
pieswo t. 
check input for typel (Alpha, Beta,Gamma,Thetacrit,D1l) :- 
convert rads to degr (Alpha, AlphaLeg), 
peuvertarads to degr (Beta, BetaDeg), 
convert rads to degr (Gamma, GammaDeg), 
convert rads to degr (Thetacrit,ThetacritDeg), 
tell (user), 
write (’ ERROR in type 1 input: A="), 
write (AlphaDeg), 
write(’ B="), 
write (BetaDeg), 
write(' G='), 
write (GammaDeg), 
write (’ Die"), 
write (ThetacritDeg), 
write (Dije nl, 
Bae 6. 


PPR RRRERAKKKAKKK KEK EK RKKKA KE KKKERKKKEKKKEKKKEKKE eoe ee eo e e e Re e e e e e ee e kk I I 
* 


^ This predic. draws lvis (Type 2) boundaries, ie, boundaries between 
* one visible and one hidden HCA edge. 
* 
* Updated 31 Jan 89 
* 
See ou ivis bdry” draws a boundary for edge 1 visible and edge 2 hidden; 
fee Pletbdry2 inv” draws a boundary for edge 2 visible and edye 1 hidden; 
* 
* pt D 
* Ci : interior (high) cost f 
* Ce : exterior (low) cost i High-Cost Area 
* Alpha : included angle between pt Pl / Interior, cost = Ci 
* the two edges. Li 
* Beta : angle between first [oes 
* edge (pt V to pt A) and ena? Alpha 
a a line betveen the pese 
A vertex and the goal. \: Gamma 
EE I distance from goal to vertex. : 
* Angle : angle needed to rotate pep pt A 
: the x-axis counterclockwise . Beta 
* to bring it parallel with \ 
E the first edge (V to A) : Exterior, 
NV coords of second point, N cost - Ce 
* the vertex. + 
+ Goal 
* 
A lere the rotation angle = 0 
* 
E 
oli bar (e7Cu Ce, 4a, Yap Mab, Xb, Yb, Xe, ¥o, Ned, Xd, ¥d) :- /* Opposite edge. */ 
not (opposite point (Xc,Yc)), 
pseu optimal path([{Xc,¥clOFc]), pass nano anortcutting * / 
counterclockwise ([Xc,YclOFc]), /* If before opposite point.*/ 
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tell (user), 
write('l1v/b (Type 2) bdry being plotted between edges '), 
write(Hab),write(' and '),write(Ncd),nl, 
goal point (Xg,Yg), /* 1iv/- (Type 2) —bdr e 
translate linet ib, Xe, 1c, Xa, rd, Kote dtr, 
path length ( (tee arc Ol), 
distance (Xb, Yor Xe, enbzcalc), 
add epsilon if zero(0zcalc/ D2; 
distance (Mb MB xq, 1g, D3); 
distance (Xc, Yc; Xd, 1a Dcd),; 
distance (Xa, Ya, Xb, Yb, Dab), 
distance (Xa, Ya, Xg, Yg, Dag), 
distance (Xa, Ya, Xdtr, Ydtr,Dadtr), 
distance (Xa, Ya, Xc, Yc,Dca), 
Cosl is (Dcd^24Dab^2-Dadtr^2)/(2*Dcd*Dab), 
arccos (Cosl,AlphanAbs), 
Sign of Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Alpha), 
Cos2 is (D3"2+Dab”2-Dag”2)/(2*D3*bab), 
arccos(Cos2,Beta), 
Cos3 191 (D272fbab"2-Dca 2)7 12 D2-Dab)7 
arccos (Cos3, Gamma), 
compute angle of rotation(Xd, Yd, Xc,Yc,RotaA), 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Conn), 
plot lvis bdry2 (before,Conn,Ci,Ce,Nab,Ncd, 
Alpha,Beta,Gamma,D1,D2,D3, 
Dag. Dab, Xc, Yc, ROBA) lo. 


plot lvis bdry(o,Ci,Ce,Xa, Ya, Nab, Xb, YD, Xc, Yc Nea 10) /* opposite edge */ 
o pseudo optimal path([Xd, Yd|OPd]), /* Must be after opp pt 77 
tell (user), 
write(’lv/a (Type 2) bdry being plotted between edges '), 
write (Nab),write(’ and '),write(Ncd),nl, 
goal point (Xg, Yg), /* ìv/- (Type 2) bdry */ 
translate linea Ya Xd VA Xe, Yo xXerr verry, 
path length([Xd, Yd/OFd],D1), 
distance (Xa, Ya, Xd, Yd,D2calc), 
add epsi lene tf zero(D2calc D2), 
distance (Xa,Ya,Xg,Yg,D3), 
distance (Xc, Yc, Xd, Yd, Dcd), 
distance (Xa, Ya, Xb, Yb, Dab), 
distance (Xb, Yb, Xg, Yg, Dbg), 
distance *b7 vb, Xctr, Yetu, Dbct ry, 
distance (Xb, Yb, Xd, Yd, Ddb), 
Cosl is (Dcd^24Dab^2-Dbctr^2)/ (2*Dcd*Dab), 
arccos(Cosl,AlphaAbs), 
sign of Alpha (AlphaAbs,Xb,Yb,Xa,Ya,Xd, Yd, Xc, Yc, Alpha), 
Cos2 18 (D3° 24Dab° 2-Dbg" 2) / (27837 babe 
arccos (Cos2, Beta), 
Cos3 1s (D2271p35952-Dd552)]7(12*p2*pab); 
arccos (Cos3,Gamma), 
compute angle of lrotation(Xd, Yd, XC, YC ROCAIS 
connected (Xa ra XD, Yb, Xc; Yc, Xd, Yd, Conn), 
plot lvis bdry2(after,Conn,Ci,Ce,Hab, Ncd, Alpha, Beta, Gamma, 
DI,b2,D3,Db3,Dab,Xd,; X0. BOEARILIUE 


plot Ivis_ hbdry (b, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, ¥d) ;- /* before opp edgema 
optimal path (xd, ve c(C), Xpl, Yorre ae 
counterctockwrse(pxd Yd,c(C), Xpl, 0p DEI 
tell(user), write('lv/b (Type 2) bdry being plotted between edges '), 
write(Nab),write(' and '),write(Ncd),nl, 
goal point (Xg,Yg), /* 1iv/- (Type 2) Ddr 
translate iine (Xb, YD Xc, re, Xd, Yd, Xdtr, Yatini 
distance (Xd, ¥d,Xp1, Yp1,bDdp), 
dsSeptosnontcuPMrIdg(xe ro, pP PEE 
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path TengEh(lXplsYpLpEJoDbi), 
distance (Xb, Yb, Xpl, Yp1,D2calc), 
add epsilon if zero(D2calc,D2), 
distance (Xb, Yb, Xg, Yg,D3), 
distance (Xc, Yc, Xd, Yd, Dcd), 
distance (Xa, Ya, Xb, Yb, Dab), 
distance (Xa, Ya, Xg, Ya,Daq), 
distance (Xa, Ya, Xdtr,Ydtr,Dadtr), 
distance (Xa, Ya, Xpl, Yp1,Dpla), 
Cosl is (Dced*2+Dab*2-Dadtr%*2) /(2*Dcd*Dab), 
arccos (Cosl,AlphaAbs), 
sign of Alpha (AlphaAbs,Xa,Ya,Xb, Yb, Xc, Yc, Xd, Yd, Alpha), 
osz is (D3^2*Dab^2-Dag^2)/ (2^D3*Dab), 
arccos (Cos2,Beta), 
e953) 19 (D29524pab^2-Dpla^2)7/(2*D2*Dab), 
arccos (Cos33, Gamma}, 
compute angle of rotation(Xd, Yd, Xc,Yc,RotA), 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Conn), 
7* changed Xc, Yc for Xpl,ypl */ 
plot lvis bdry2(before,Conn,Ci,Ce,Nab,Ncd,Alpha,Beta,Gamma, 
pio Dad, Dab, Xpl,Ypl,RotA),!. 


Bleu, lvis bdry (a, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc,Ncd,Xd,Y¥d}) :- /* after opp edge */ 
optimal path([Xc,YXc,c(C),Xpl, Yp1IP]), 
Clockwise ([Xc, Y¥c,c(C),Xpl,Ypl1liF}), /* discriminates btwn OF’s */ 


/* in opposite directions from opp pt. */ 
tell(user), write('lv/a (Type 2) bdry being plotted between edges '), 
write(Nab),write(' and '),write(Ncd),nl, 
geal point (Xg, Yg}; a ul pe ia) bdry */ 
cransdate linelxa, Ya, Xd, Yd, Xc, Yc,Xctr,Yctr), 
distance (Xc,Yc,Xpl, Ypl,Dcp), 

Bucerteosbortcut flagiXd, Yd, Xpl,Ypl), 
path _length((Xp1,Yp1/P),D1), 
distance(Xa,Ya,Xpl,Ypl,D2calc), 
add epsilon if zero(D2calc,D2), 
distance (Xa,Ya,Xq,Yg,D3), 
d:ustanceiíXc, Yc, Xd, Yd, bcd), 
distance (Xa, Ya, Xb, Yb, Dab), 
distance (Xb, Yb, Xg, Yg, Dbg), 
distance (Xb, Yb,Xctr, Yctr,Dbctr), 
distance (Xb, Yb,Xp1,Yp1,Dplb), 
Cosl is (Dcd”*2+Dab”2-Dbctr”2)/(2*Dcd*Dab), 
arccos (Cosl,AlphaAbs), 
sign of Alpha(AlphaAbs, Xb, Yb, Xa, Ya, Xd, Yd, Xc, Yc, Alpha), 
Cos iS (D3°2+Dab 2-Dbg 2) /(2*D3*Dab), 
arccos (Cos2, Beta), 
o aD 2łDab^2-Dp1b^2)/ (2+*D2*Dab}), 
arccos (C033, Gamma), 
compute angle of rotation(xXd, Yd, Xc, Yc, RotA), 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Conn), 
/* changed Xd,Yd for Xp1,Yp1 (why Xd, Yd???) */ 
plot_lvis_ bdry2(after,Conn,Ci,Ce,Nab,Ncd, Alpha, Beta, Gamma, 
Du DA Dp3 Dbg.Dab.Xpl,Ypli.BRotA),'. 
a oor or or or ot orto ot o Ye t7 
Hu ssburv2(before,Conn,Ci,Ce,H1,H2,A,B,G,D1,D2,D3, Dag, Dab, Vx, Vy, RotAngle):- 
abolish(bdry,1), 
abo)ish(done, 0), 
abolish(thetal,1), 
Cagtem) yom iry (Ci,Ce,\,B,G,D1,D2, D3, Daeg, Dab, V%, Vy) , 
rotate Ddry (PotAngle), 
remove last bdry coord if disconnected (Conn), 
bdry (Bdry), 
reversegpatch list (BdrypRevBdry), 
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truncate off map(RevBdry,FinalBdry), 
assert (initbdry([N1,N2],FinalBdry)), 
JA tell(bdry out),write(' Type 2 '),nl, 
write to bdry file(bdry,Bdry), 
output to figurem. mle, / 
plot 1vis bdry2(after,Conn,Ci,Ce,N1,N2,A,B,G,D1,D2,D3,Dbg, Dab; Vx, vy, RotnAwe a). 
E abolish(bdry,1), 
abolish(done,Q), 
abolish(thetal, 1), 
calc lvis bdry(Ci, Ce, A B G, D1, D270 tag, Dab, Ys, yi 
invert bdry, 
rotate bdry (RotAngle), 
remove last bdry coord if disconnected (Conn), 
bdry (Bdry), 
reverse path (ase (bdr, he wbary) | 
truncate off map(RevBdry Finalban ae 
assert (initbdry ({N1],N2J,FinalBdry)), 
Ja tell(bdry_out),write(" Type 2 invi D Pmi; 
write to bdry file(bdry, Bdry)i 
output to figure file, +7 
! 


calc lvis_ bdry(Ci,Ce,A,5,6,0D1,D2,D3, bag, Dab; va NL 
assert (bdry ({Vx,VyJ)), 
maxX (XMax), minX (XMin), 
LargeNumber is (XMax - XMin)*100, 
assert (sc_bdry pt dist (LargeNumber)), 
CostRatio is Ce/Ci, 
Tc is asin(CostRatio), 
get timin (Dag, Dab Di Timin}, 
get tImao (B, T max 
precision(Precision), 
DelTl is (Tlmazx-Timin)/Precision, 
Tlinit is Tlmax 4 Deli. 
assert (thetal (Tlinit)), 
retract (thetal (Tlprev)), 
Tl XS JUpreocc- pour 
T1 >= Timin, 
assert (thetal(T1)), 
calc ivis bdry pt (ic,A,2,6,0),)2,D3,11,. 5) 
store lvis results (Xl, XZ, 1c, Vx, Vy pee 


ee i a. 


abolish(sc bdry pt dase ME 


get timin(Dag, Dab, D3) fiman) - 
pi (ea, 
Cosi is (Dag^2łDab^2-D3^2)/(2*Dag*Dab}, 
arccos (Cosl,Tlminplus90), 
Timin is Timinplus90 - Pi/2, !. 
get timax(27 Gnas as 
PIPS 
NinetyminusB is Pi/2 - B, 
Timax is NinetyminusB, !. 


calc_iìvis bdryipt (Tc, ABG, DI, D270 PEI 
T2 is asin (sin(Til) *sin( te) 7, 
Tiplusb 13 30 XR. 
TcplusAminusT2 is Tc + A - T2, 
T2minusA is T2 - A, 
T2minusG is T2 - G, 
Fl xs sin(A) —scogsqr2)*sin(pe) 
X2 is (-Dl*sin(Tc)*cos(T2)^cos (T2minusA) 
+D2* (cos (T2minusA) *sin(G)-cos (T2minusG) *F1) 
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t1)3* (cos (12) /eos (11) ) * 
(sin(B) *sin (Tc) *cos (T2minusA) +cos (TlplusB) *F1) ) 
/ (sin (TcplusAminusT2) *F1 
+cos (T2minusA) * (cos (TctA) +cos(T2))), 
Xl is -X2* (sin(TcplusAminusT2) /cos (T2minusA) ) 
-p2* (cos (T2minusG) /cos (T2minusA)) 
*D3* (cos(T2) *cos (TlplusB)/(cos(T1)*cos (T2minusA))), !. 


Beangiate line (Xref, Yref, X1,Y1,X%2,Y¥2,X2trans, YZtrans) :- 
DelX is Xl1-Xref, 
Dely is YI-Yref, 
X2trans is X2 - DelXx, 
Y2trans is Y2 - Dely, !. 


Ae oast pt ([X,Y,Xlast,Ylast]), [X,Y]}. 
uto last _ pt([X1, Y1|R]; [X,Y)) Ls 
atero last PENR, [X,Y]}, !. 


pues results(X1,X2, Tc, Vx, Vy) :- 
not (shortcut (_, ,Vx,Vy)), 
Meca is Vx — Xl — X2*sin(Tc), 
Yody is Vy 4 X2*cos(Tc), 
retract (bdry (BList)), 
assert (bdry([Xbdry,Ybdryl|BList])), !. 


EMESNIvIS results(X1,X2,TCc,Vx,Vy) :- /* The effect of rules 25 3 */ 
Shortcut( , ,Vx,Vyl, /* is to exclude the initial  */ 
Xbdry is Vx - X1 - X2*sin(Tc), /* portion of a bdry which Lr 
Ybdry is Vy 4 X2*cos(Tc), /* starts at a s/c pt, as long*/ 
distance (Xbdry, Ybdry, Vx, Vy, Dnew), /* as the bdry is coming back */ 
Begmbdry pt dist (Dold), /* toward the s/c pt, and xA 
Dnew >= Dold, /* include the later portion */ 
retract (sc bdry pt dist (Dold)), /* as it goes away from it, a 
essere (sc bdty pe dist (Dnew)), /* since thetamax is calculated*/ 
retract (bdry (BList)), /* for the non-s/c case and is*/ 
assert (bdry([Xbdry,Ybdry|BList])), !. /* too large for the s/c case.*/ 


IucsIv:scresults(X1,X2, Tc, Vx, Vy) :- 
siiemeeuc (7) s, Vx, Vy), 
Mary as yx => X1-- X2*sin(Tc), 
APO ag Vy 4 x2*cos(iTc), 
distance (Xbdry, Ybdry, Vx, Vy, Dnew), 
noctnudcetoscsburvsptodaist(Dold)), 
Dnew < Dold, 
annere Se dry PE dist (Dnew}), !. 


/* If edge AB is parallel to CD, AlphaAbs will be 0, so Alpha is 0. */ 
croquet a ypna(), Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, 0) . 
/* If AB intersects CD on the B-side of AR, Alpha is positive. */ 
sign_of_Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, AlphaAbs} :- 
line intersection (Xa, Ya, Xb, yb, Xc, Yc, Xd, Yd, X1, Y1), 
distance (Xi, Yi, Xa, Ya, Dia), 
distance (X1 Yi XD, Yb, Dib), 
Dia >= Dib. 
/* Otherwise, AB intersects CD on the A-side of AB and Alpha is negative. */ 
sign_of Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, ~AlphaAbs) . 


/* If X-0, return a slightly positive value, else leave X unchanged */ 
add epsilon if zero(0,0.0001). 
add epsilon if zero(X,X). 


/* returns Conn = conn if the two line segments are connected, */ 
/* and Conn = disc otherwise. */ 

connected (Xa, Ya, Xb, Yb, Xc, Yc, Xa, Ya, conn). 

connected (Xa, Ya, Xb, Yb, Xb, Yb, Xd, Yd, conn) . 


connected (Xa, Ya, Xb, Yb, Xa, Ya, Xd, Yd, conn) . 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xb, Yb, conn). 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, disc). 


/* If the two edges are not connected, the first point in the */ 
/* Bdry list is not part of the boundary, but only there to */ 
/* specify the point about which to rotate. */ 
remove last bdry coord if disconnected (conn). 
remove last bdry coord if disconnected (disc) tom 

retract (bdmv(Bdry)), 

reverse path list (Bdry, [X, Y| ReversecdBdry T); 

reverse path list (ReversedBdry, Revisedbdry), 

assert (bdry (RevisedBdry)). 


[RARARRARARA RARA AA RA ALA AA RARA ARA AAA RA RARA AAA ARA ARR A XR TRS ELE 
* 
* Plot Ovis boundaries, between two hidden edges. 
* 
* Updated 12 Jan 89. 
ta 


plot Ovis bdry (b,b, Ci, Ce, Xa, Ya, Nab, Xb, 1b, Xe, Ye NCAA 
tell(user), /* ' before' compared with 'before' */ 
write('Ov/M(b) (Type 3) bdry being plotted between edges '), 
write(Nab),write(' and '),write(Ncd),nl, 
abolish(bdry,1), 
optimal _ path ([Xd, Yd, c (Ca), Xp YpIIOPpl]), 
counterclockwise ([|xd, Yd, c(Ca) DI Ypl|OEDpL)- 
path length ([Xp1, YPI OEP] DPE 
optimal patio rob co Np IOPp3p 
path. length @[%p3; Yp3 |OPpai7 bia 
D2 xs bplgs DI 
distance (Xa, Ya, Xb, Yb, Dab), 
distance (Xa, Ya, Xpl, Yp1,D3), 
distance (XD Ybr PEPI DERD); 
distance (Xd, Yd, Xp1,Yp1,Ddpl), 
di stance (Xa, Ya, Xd, Yd, Dad), 
distance (Xc,Ye Xd Yd Dcd)s 
distance (Xp3, Yp3, Xa, Ya,2), 
piros 
Cosl is (D3^2+Dab^2-Dbp1^2)/(2*D3*Dab), 
arccos (Cos1,A), 
Cos2 is (Wapl > 21+b247 5m3d^2)7 (2 Dadap i D]; 
arccos (Cos2,PiminusBeta), 
B is Fi - PiminusBeta, 
Te is asiniCe/Cri). 
compute angle of rotation (Xd, Ya) Xe, Ye, Rochnata 
calc bdry pt OvisM(A,58, Tc, Xp, ipl, 2 DAD DU ome 
calc bdry pt OvisM(A,B, Tc, Xpl,Ypl, 2, DU, 02,03, Ved, x Vicia) a any 
abolish (bdry,1), 
asgert (bdry ([Xlbdry, Ylbdry, *2bdry,; Y¥2bdny, sor ee 
rotated bdsy) (Petaagtle), | 
bdry([Xl, Yl X2 1 
correct error in; conn edges (iD YD Xo YO pL YR eee n NE 
assert (anitbdry (Mab, Ncd) x25, 125, let) eee 


plot Ovis bedry(a,a,Ci, Ce, xa, ia, Nab, x, 1b, Xe, \eanea ye dee eee 


tell (user), /* ‘after’ compared with ‘after’ */ 
write (’Ov/M(a) (Type 3) bdry being plotted between edges '), 
write (Nab) ,write(’ and '),write(Ned),nl, 


abolish(bdry,1), 
optimal path([Xc,Yc,c(Cc),Xp3, YpST Ep SUE 
path. Tengen pato») A 
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optimal path([Xa, Ya,c(C),Xp1,Ypl1|OPp1]), 

clockwise ({Xa,Ya,c(C),Xpl,Ypl|OFp1])), 

path lenath([Xp1,Yp1|OPp1),Dp!9), 

DZ Merlo -~ DI, 

distance (Xa, Ya, Xb, Yb,Dab), 

distance (Xd, Yd, Xp1,Yp1,D3), 

distance (Xa, Ya, Xp1,Ypl,Dapl), 

distance (Xc, Yc, Xp1l, Yp1,Dcpl), 

distance (Xa, Ya, Xd, Yd, Dad), 

distance (Xa, Ya, Xb, Yb, Dab), 

distance (Xc, Yc, Xd, Yd, Dcd), 

distance (Xp3, Yp3, Xd, Yd, Z), 

pri 

cosiós (D3°Z21Ded 2—Dep1~2)/(2*D3*Dcd), 

arccos (Cosl,A), 

295092158 (Dapl^21D3^2-Dad^2)/ (2*Bp3p1*Db3), 
arccos(Cos2,PiminusBeta), 

B is Pi - PiminusBeta, 

Tc is asin(Ce/Ci), 

compute angle of rotation(Xb,Yb,Xa,Ya,RotAngle), 

Ea cEEUgPUNpt OvisMg(A-B,Ic,Xpl,Ypl,2,D1,D2,D3,0, XIbdry,Ylbdry), 
calc bdry pt OvisM(A,B,Tc,Xpl,Yp1,2,D1,D2,D3,Dab, X2bdry, Y2bdry), 
abolish(bdry,1), 

assert (bdry ([X2bdry, Y2bdry, Xlbdry, Ylbdry,Xp1,Yplj)), 

Oe ed y , 

rotate2 bdry (RotAngle), 

bary [X1 Y1; X2, Y2); 

eorne ei error in Conni edges (Xb, Yb, Xc, Yc, Xpl,Ypl,X2,Y2,X2r,;Y2r), 
aasert init bDdry ((Nab, Ncda],;, [X2r,Y¥2r,%1,¥1])), !. 


wes bdry (b,a, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc,Ncd, Xd, Yd) :- 
tell (user), /* *before’ compared with ‘after’ */ 
write (’Ov/D (Type 4) bdry being plotted between edges '), 
write (Nab),write(’ and ’),write(Ncd),nl, 
abolish(bdry,1), 
optimal path([Xb, Yb,c(C1),Xp1,Yp1|OPp1]), 
counterclockwise ([Xb,Yb,c(C1),Xpl,Yp1ļ|OPp1)J), 
Pathe onde spi ept(OPpl], D1), 
apra eo e dese 1C2),Xp2,Yp210Pp2]), 
cloro Mere Ez), Xp2, Yp210Pp2]), 
patbetcenagtut pz Yp2l6Fp2],D2), 
not (same (D1,D2)), 
distance (Xpl rpl, Xp2,;Yp2, D3), 
distances XC, YC, Xpl;Ypl,Depl), 
distance (Xc, YC, Xp2, p2; DCp2),; 
distance (Xb, Yb, Xpl,Yp1,Dbpli), 
distance (Xb, Yb, Xp2, Yp2, Dbp2), 
pi(Ei), 
COS (DS? 2tDcp2 7 2=DCEp152)/(2*D3*Dcp2), 
arccos (Cosl,Piover2plusAlpha), 
A is Piover2plusAlpha - (Pi/2), 
ca DS: 21 Dbpl?*2-Dbp2323/(2*D3*Dbp1), 
arccos (Cos2,Piover2plusBeta), 
B is Fiover2plusBeta - (Pi/2), 
Testa sin (cel 
compute angle of rotation(Xa,Ya,Xb,Yb, RotAngle), 
cat MO US ISD ÍA, B, 16, 2P1,Yp1,D1,D2,D3,0,X2bdry,Y2bdry), 
ealembarvapt J0Uviob (A,B, ic, xpi, Y¥pl,01,D2,D3,Dbpl, Xibdry, Ylbdry), 
abolish(bdry,1), 
guscentbdrcCp5bdryv,YlbdrvP?X2bdry,Y2bdryj;Xpl;Ypl]l)), 
inverntebdry, 
rotateZ bdry(RotAngle), 
bdry Ch Werle, X2,Y¥2))., 
cone PEO E 1) opi edge (Xb, ¥b,Xc, Yc, X1,Y1,X%lr,Yir), 
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assert (initbdry([NabiNcd], (Xlr, Yir a a E 


— e æ ë —— ë — mee 


tell (user), write(’ Bdry does not exsist .’) umb aie 


calc bdry pt _OvisD(A,B,Tc, Xo, Yo,D1,D2,D3,X1,X,¥) :- 
> TcplusA is Tc + A, 

Fl is sin(A) + cos(TcplusA) *sin(Tc), 
Tl is cos(Tc)*(sin(B)-sin(Tc)*cos(TcplusA)) 4.CcO3S (Ec ii, 
T2 is cos(Tc) - sini(@eplush) RU 
T3 is cos(TcplusA)*cos(Tc)*sin(Tc), 
Denom is cos(TcplusA)*cos(Tc)*cos (TCKFB) *cos (Tc) -sin(2*Tc*A4B) *F], 
X2 is (X1*T1 * D3*T2 + (D2-D1)*T3) / Denom, 
X is Xo - (Xl*X2*sin(Tc)), 
Y is Yo - X2*cos(Tc), !. 


calc bdry pt ÜvisM(A,B,TcC,XO,YO,2,D1,DZ DOM M Y) 
|^ Tl is sin(A*B)4sin(Tc)*cos(Tc4*A4B) -cos (Tc) *sin(Tc), 

T2 is D3*(sin(A)'sin(Tc)*cos(Tc*A)), 
T3 1s D2*cos(Tc)*Srmisc) 
I4 is Z2*s1it(te)*cos Ger 
T5 is cos(Tc)-cos(Tc-A-B)*sin(Tc)*sin(A-*B), 
X2 is (XI -IL 832 ee Nm 
X is Xo -XNA sines 
Y is Yo + X2*cos(Tc), !. 


/* If edges are connected then pt B = pt C and bdry */ 

/* should start exactly at pt PIS 

correct error in_conn_ edges (Xb, Yb, Xb, ¥b,*%pl,; ypu , ,Xpi,Ypl). 

/* 1f edges are not connected use the */ 

/* bdry point as calculated. */ 

correct error in conncedass A CELSUS 

/* If edges are part of the opposite edge, then */ 

/* bdry should start exactly at the opposite point. */ 

correct error in opp edge (XbAYD,Xc, YC, ere, oe ee 
opposite point minus (xi lb), 
opposite pornt "plus (AG 0), 
Opposite point (Xopp, Yopp). 

/* If not, then leave start of bdry unchanged. */ 

correct @rror in oOppPecdge (pwn A, AA 


[RK KAR KK RK RRR RRR KR KARR he e he e e e e e ee ee e RRR RAR AAA KR KAR RRR RR A RR KK RRR kk 


plotoebdry computes HCA Interior Opposite-Edge Boundaries (Type 5) 
Assumes no shortcutting! 


: Updated 12 Jan 89. 
<7 


plotoebdar Gre Rama vb yb) 
plotoebdry (Ci Ce, Xa, Ya; Xb Yb, B). 
plotoebduy(¢1 Ce ra O BA 
optimal path([Xb,Yb| ],D1), 
optimal path(([Xa Yal Jj D) 
distance (Xa, Ya, Xb, Yb, D3), 
compute angle of rotation (xb, Yb, Xa, Ya, RotAngle), 
plot2oebdry (Ci, Ce,D1,D2,D3, Xb, Yb, Rot anagre ear. 
/* tell(user), ,vwrite([Xa, Ya xb YD) nin 
! 
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migtzocbdry(intCost, &ytCost,D1l,D2,D3,Vx, Vy, Angle, RevBdry) :- 
mato loe: Foro 
tell(user), nl,nl, 
/* write('HCA Int Opp-Edge (Type 5) bdry being plotted for edge '), */ 
TC is asin(ExtCost/IntCost), 
calc oebdry pts(Tc,D1,D2,D3, Vx, Vy, Angle), 
rotate bdry(Angle), 
retract (bdry (Bdry)), 
remove last pt (Bdry,RevBdry), 
truncate off map(RevBdry,FinalBdry), 
assert (initbdry (oe, FinalBdry)), 
/* tell (bdry out),write (’ Ty pera) nm, 
Wrvee tO bdry file (bdry, RevBdry), 
autpuüut to figure file, */ 
t 


EsMcuoebdry pts(Tc,D1,D2,D3,Vx,Vy,Angle) :- 
AS (D3+D2=D1)/2, 
X22 is X11/sin(Tc), 
Xa is Vx * X11, 
Mamie Vy, 
Xb 18 Vx + X22*sin(Tc), 
Nb V+ X22" Cos (TC), 
assert (bdry([(Xa,Ya,Xb,Yb,vx,VyJ)), !. 


freevalize fords :- 
abolish(bdry,1), !. 


/* First check whether bdry starts on the map. If so, call trunc..2 */ 
Lf noBP call trume..3 */ 
Etnncate off map([X1,Yl1,X,Y|B],B2) :- 

minX(MinX),minY(MinY), 

maxX(MaxX),mazxY(MaxY), 

DelX is MaxX - HinxX, 


ÉD sHMaxX,-Y1l » MinY, Yl < MaxY, /* starts ON the map.*/ 
Enuncsrcesortomape([XLb,Yl,X,YIB],B2), !. 

puuscate off map([X1,Y1,X,YIB],B2) :- /* starts OFF the map.*/ 
Enugncatecoffomap3([X1,Yl,X,Y!B],B2), !. 

nuucate off map2t[X1, Y1,X,Y1B], (X1, Y11B2)) :- /* Assumes that Bdry */ 
minX(MinX) minY (MinY), /* starts ON the map.*/ 


maxX (MaxX) maxY (MaxY), 

DelX is MaxX - Minx, 

MinX2 is HinX - 0.1*DelX, 

MinY2 is MinY - 0.1*DelxX, 

MaxX2 is MaxX + 0.1*DelY, 

MaxY2 is MaxY + 0.1*Delx, 

AZ X MaxX2, Y > MinY2, Y < HaxY2, 

Peumeare off map2([X,¥1B),B2), !. 
Brunecate jeer mapZ( (el, Y1,X,Y1B], (X1,Y1,X,Y)) :- m 
muuneagtexsoffomap2([(X,Y),(X,Y]) :- Ll. 


pmuauucdgbesortomap3([X1,Y1,X,Y], [X1, Y1, X, Y]). /* Bdry is entirely off the map */ 
/* except perhaps for the last pt. */ 
Inounmestexotraemap3([Xi,Yl,X,Y[IB],B2) :- INIBary starts off the map.*/ 


eun atel off map([X,YIB], B2), *. 


HuurtEsHortcut flag(Xv,Yv,Xv,Yv). 
assert shortcut flag(Xv,Yv,Xpl,Ypl) :- 
assert (shortcut (Xv, Yv,Xpl,Ypl)), !. 


aloe koisen eC], Xi, YilOoOF]) :- 
redion relist (P), 
ocea en edge (X1, Y1, R, [Xa, Ya, Xb, Yb]), 
em YLXI,Yl,Xb,Yb), !. 
counterclockwise([X1,Y1,c(C),Xi,YilOP]) q 
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region elrstR); 
get_XYccw edge(X1,Y1,R, (Ma, Ya, Xb, YD 
on ay A A A 


get_XyYcw_edge (XI, V1, (Xa, Ya, 0,0, Xb, Yo) a, ta, X71 ])) 
on ray (Xl; Y1, XD YD ra Ya) oF 
get XYcw edge(X1, Y1, [Xa Ya o ME do: a 


get _XYcw edge (Xi Yi TR Edge) a 


get_XYccw_edge(X]1,Y1, [Xa,Ya, , ,Xb,Yb|R], (Xa, Ya, Xb, Yb) ) 
on ray (Xl Yi etapa, | 

get_*XYccn edge (1x1, YI X3 AD DIE IS 
get _ XYccw edge(XI Yi R Edgel: 
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Poe ee AEE ARR KR RAKARAKAKAHAKKKARAEKAKRKREAKKKAAKKKRERKEAAAKRKRERKREKKEKKREKHEAER 
X0 00e ARA RARA RRA RAR RRA AR RR RRA ARRE RRAAR AR RAR ARA AAA AAA AAA ARA RR RR RR A 
* 


File "boundary _ join" or "bj" 
Updated 30 Jan 89 


aryen Eruncates boundaries and joins them together into 
a network of the active boundaries inside a homogeneous-cost region. 


+ >+» + MR + + 


* 
RERARAAA AAA RA AAA AAA ARA RARA A A AR A AA AAAAAARA AAA RA AAA 


REIR ERRE RRA RERRARARAREARRA RARA AARRARRARAR A RANRRAARA RARA RARRA RARA RARAS 


f NR ek e d ke e e e e eR heh Re eR Re e GG A A A M A x à A x x 
f ****9* kh kk ik kk kh kktk Top-level predicate XC A XU UU I A A x x / 


EIA PARNER AERA EHEKAEAHRARAKAAKRAKAEKNHHAEREKRKAAHKHKKERAEWHKKEHHHARHKEARHEKKRA HH / 


DBaEy join :- 
initialize, 
first levd b drys (Al), 
assertiotarbary setilI)), 
aesetriicurrent bdry set(A1)), 
potracbeburrent bdry set (Acur)), J*tostart of whalesnotsdonewloop */ 
Peace cul (old bary set (Aold)), 
not (same set (Acur, Aold)), 
ageere (Ola bdry set (Aeur)), 
next level bdrys(Acur, Anew), 
assert (current bdry set (Anew)), 
done (Anew), /* end of while-not-done loop */ 
get final bdrys(Afinal), 
output (Afinal), 
cleanup, halt, !. 
IN join ;- 
tell (user), nl,nl, 
write (" Checking for center shortcotting'),nl,nl, 
cunuEIncompbete trees, 
get_final_bdrys (Afinal), 
bdayecage intersections (Afinal, BEI), 
Pilegexact opposite pt (BEI,P), 
peeurse unless done(P), 
output (Afinal), 
cleanup, halt, !. 
bary Join -= 
pEWusser), ni.nl, 
write(' ERROR n *"bdry-jorn'"- doesn^"t-converge^),nl,nl, !. 


Pee eR PEA KREEARRAKREEKERKEAKRARKEKHENKEHHAAARKRAKRRKKRARH ARRAS / 


f*NSMAhRE NR AAA AA A hh Second-level predicates RARARARARARARARAARAARAAS/ 
f 8 Sh kh hk NUR NU UA UU AO e e 0 e ee e Re & UR UAR 


initialize :- 
tell (user), 
nl,nl, write(’Boundaries being joined:’), nl,nl, 
abolish(ctr,; l), 
assert (ctr(1)). 


first level bdrys (2) 2 
number of edges(W), 
index rst ItoJ(1,N, IndexListQ), 
cons(IndexListO,[[1,2]],IndexList), 


20 


assert (indices (IndexList)), 
first level bdrys! (Ala), 
order indiceSkAr n nig 


next level bdrys (Also) 
reset (A1,A2), 
propogate next level bdrys(A2), 
get active bdryoset(A3), |l. 


done(A) :- 
one bdry trees 
tell (user), ni ni nl, 
write to scree: DONE = single bdry-tree™), nivarnl, —*. 


get final bdzysia) 
derbi x 


bdry edge intersect ons (eae 

bdry edge intersections (([([1,01,8, LPC) itil), J), Se, cee heels 
edge bdry intersectiom(h, [1 , uJ eeu), 
bdry edge rntersections QOL BERN 

bdry edge intersections (ao by ee eee er) ie 
bdry edge lintersect rons (CABE TPE 


elim incompleteat r ecoin 
tree([1,J],L,R), 
not (complete tree(tree (I Fie 
eliminate tree tbdrys(tree((1 JIPE RI), 
farr n 

elim incompleteftrees m. mi 


find exact opposite wp eee ees 
find exact opposite PEBE DIT 
opposite edge (OE), 
new- opp pte (OE OR Edu 

find exact oppositelpt minns 

find exact opposite pti({([[1; J]. B [LX EBET] E 
optimal path([LX, LY; c (C) X2 7 ere 
update_opp_edge (1, J, [LX CY; c (C) X2, Yo OnE 
find exact toppers tempi BED E F 


recurse unless done ((7opp2, 1opp24) ee 
not (first pass done), 
opposite point (Xoppl, Yoppl), 
not (same ([Xoppl, Yoppi), [Xopp2, Yopp2])), 
retract (Opposite point (Xoppl, Yape wae 
assert (oppõ9ite point (XPP rar 
assert (fir3t pas3 done}, 
cleanup2, 
boz, 12 

recurse unless done (opp, (efr2)) a 
tell (user),nl,ni,nl, , 
write ton geree an DONE - Finished Second Pass’), nl, ni, ni E 


output aA} > 
write heading, 
write bdrys to filei(hca opm A) emcee 


cleanup = 
abolish(ctr,1), 
abolish(tbdry,5), 
anolish (cummentwindiy set, 17 
abolish(bdry list,1), 
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abolish(bdry intersection, 5), 
abolish(initbdry, 2), 
abolish (tree,3), 
tell (user), 
ni pnl, 
write (' Boundary generation complete: results in file ''hca opm''^*), 
niens t. 
cleanup2 :- 
abolish(ctr,1), 
abolish(tbdry,5), 
abolish(current bdry set,1), 
abolish(bdry list,1), 
abolish(initbdry, 2), 
abolish(region elist,l), 
abolish(pseudo optimal path,1), 
abolish(tree,3), 
tell(user), 
nl,nl,write('Pass Two beginning'),nl,nl, !. 


f RR kh hh ek i hh Rh e Rh RARA RR ARRA RRA RRA RARAR RRA RRA A RARA RA ARAS 


EE 5 115:.52)74tJjon" subordinate predicates  &^***"**^A^*****»/ 
f A RRORROh UR A RU AUR RU NUR OUI OA ORO RO RU 0I UU IU ARR ARAS 


/* Assert the points at which bdrys are ‘anchored’ to the region edges */ 
assert anchors :- 
number of edges(N), 
index list ItoJ(1,N,IndexListl), 
assert anchors (Indexbist), i 
EEscerntcanchors([]) :- !. 
ASSett anchors({{I,J]|L]) :- 
ini ekbdry (I, J}, [X,YIB}), 
assert (anchor (X, Y)), 
asser Manchors (L), 1. 


reset (A, A1) :- 
abolish(tbdry, 5), 
AveesinCedge want pt, 3), 
pndecrEeundrices(A,AT) 
poedsdgertstbudrys(otd,;A1,1)7 
abolish(ctr,1), 
assert (ctr (1)), !. 


f 5 NU oh hh UR IU UU RO UR UR UU AURI AUR A AU UU UU hh 


[ttarra “FGrst-level-bdrys" subordinate predicates  *"**^**&**w*ww/ 
re ee A eH K AEA RARE EHH EN KH K HARTA HKAE TREAT HR EH HA TRADER HHH / 


uustelevebEburvsl(A,N) :- 
retract (indices (IndexList)), 
Enimeaee tst level bdrys(IndexList, N), 
caera and rta shortest Etbdrys (ShortBdrys), 
matching pairs (ShortBdrys, PairedBdrys), 
bury edge intersections (Short Bdrys, fdvetintepdrys), 
set subtraction (EdgeIntBdrys, PairedBdrys, EdgeIntBdrys2), 
cons (EdgeIntBdrys2, PairedBdrys, ActiveBdrys), 
reaggert thdrys (old, ActiveBdrys,1), 
tminusl is N - 1, 
not (list length(ActiveBdrys, Nminus1)), 
NOe(Erseelength (AcLiavendrys,)), 
1gdecxostonspeBdrys,ludexLbl), 
SetoasubsbScESOmOPnndexbist IndexLl,IndexL2), 
conp emen adex List (N, Tndexbl, IndexL2), */ 


not(same set (Inde prat. Indexb2)7 /* If same, no new bdry pairs */ 
assert(indices(IndexL2)), 
first Jeselrsburns 3n M, p 
firsta level _bdrysl(A, Nj = 
assertisingales1 nN), 
get Jtbdrys (4) 1 


matching pairs ([FirstB|Rest], RevRest) :- 
matching palrsi([FPirsts’| Rest br och RevReSE I ame 


matching pares M uM i= LE 
matching pairs] ({{IDlast, Blast, LFtfirst))], (TDfirst BETTA eS 
({IDlast, Blast, LPtfirst],([IDbDfirst,Bfirst,LEtfirst]]) :- |. 
matching pairs1([[IDlast,Blast,LFtlast]], [IDfirst,Bfirse ree irse dM LN 
matching pairsl([(101,B1,LPt1], [102,B2,LPt1] [Rest], BÉYESE? 
[IIDI,B1,LPt1],[ID2,B2,LPt1]|RevRest]) :- 
matching pairsl(Rest,Bfirst,RevResti-. 
matching pairs1([B1,B2|Rest],Bfirst,; Reyki]: 
matching pairsi([B2|Res5t], BEirst Re vReS je 


truncate Ist level bdrys([| 21] e /* Base case */ 
trunca “ist level _bdrys([[N, 3 1 les PA A E /* Last pair of bdrys: */ 
initbdry([1,N], (X1,Y1/8B1]), /* succeeds if they intersect. */ 


initbdry (CIE rez mm. 
bdry intersection([X1l,Y1|BI], [X2, Y2] B2], IntPt,Blitrunc,B2trunc), 
get counter and increment (C0), 
get counter and increment. (C1), 
assert (tbdry (new, CO, [N, 1), Blerune, Ince’ iy, 
assert (Cbdry (new, Cl, (1,2), B2t rune, In ETIO 
region elist(R), 
truncate bdry and edges([1,N], [X1,%1{81),R), 
truncate ist level bdrys (IL m IRn ee 
truncate lst level bdrys([[(Nminusl,N], bm, 1] [Rest] NO => 
Nminusl is N-1, /* Next to Last pair of bdrys: */ 
initbdry ([Nminus1,N], [X1,Y1ĮB1)})), /* succeeds if they intersect. */ 
ingtibery ( (aN ee 2 |B 2 
bdry intersection([X1,Y1|B1],(X2,Y2/B2],IntPt,Bltrunc Bla ee 
get counter and 1Increment(C0). 
get counter and incrementi iii 
assert (tbdry (new,CO, [Nminusl,H],Bltrunc,IntPt)), 
assert (tbdry (new,C1, [N,1),B2trunc, IntPt)), 
region eelist (R); 
truncate bdry and _edges((N,Nminus1)], [X1,Y1|B1],R), 
truncatestst legal bdrys (MIRES rR a, 
truncate lst level _bdrys([[1, JJ), [J,K] |Rest],N) :- /* Succeeds if bdrys are*/ 
initbdry([1I,J], [X1,Y11B1)), /* adjacent and intersect*/ 
initbdry I1 KI P: ee ee ee 
bdry intexsectron((X?,YV|Si), (22, 12782), (Ne be, Blewuie gm coum), 
get counter all dee Semel). 
get counter and increment (C1); 
asgssert(tbdry(nevw,CO, [I,J],Bltrunc Int PEIE 
assert (tbdry (new, Cli, (J, K], B2trunc, Intl eis 
regioni elist (R), 
truncate bdry and _edges([I, 3), ba, YJ Bla, 
truncate lst level  bdrys([L [o7 PRESE 
truncate lst level _bdrys([[1l, J), (%,L) |Rest),N) :- 


ordered(1,J,11,3J1), /* Recurses if previous */ 
initbdry([I1,J1], [X1, Y11 B1]), /* adjacent and intersect*/ 
region elist (R), /* rules have failed. "A 


truncate bdry and edges([I1, J1]; (XT H EHR 
truncate ist level bdrys(([[K,L]|Resc S D 


/* Asserts a temp tbdry which stopa at the region edge if inithbdry(I,3) */ 
/* intersects a region opposite edge. Always succeeds. Also asserts dis 
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I cdge bdry-intersection(K,[I,d]), IX, Y])* for each intersection point. */ 
truncate bdry and edges([I,J], (X, Y|B], [X1, Y1,h (QJ, K, X2, Y2] RJ) E 

not (bdry starts at edge(I,J,K)), 

bdry intersection([X,YI|B], [X1, Y1, X2, Y2], IntPt, Bt runc,Bltrunc), 

get counter and increment (CO), 

assert (edge bdry intersection(K,[I,J],IntPt)), 

assert (tbdry(temp,CO, [I,J],Btrunc,IntPt)), !. 
truncate bdry and edges([I,J], [X, YI B], [X1, Y1, , K,X2,Y2|R]) s 

truncate bdry and edges([I,J], [X, YIB], R), i 


musncate bdry and edges([I,J], IX, YIB], I]) :- i 

assert singles(I,N) :- /* If any vertex’s lst-level bdry */ 
Iplus1l is I + 1, /* has not yet been generated, do */ 
Tplusi < N, /* so now. */ 


Ebdry (+ + (I, IpluslJ], ,_) , 
aässert singles (Iplus1l,N), bs 
BECrtossngles(I,N) :- 
Iplusl is I +1, 
Iplúusl < N, 
pomiltebdry (>, [1,Tplusl), ,.)), 
initbdry([I, Iplus1),B), 
detwecounker and ancrement (Ctx), 
assert (tbdry (new,Ctr, [I1,Iplusl],B,[))), 
assert singles(Iplusl,N), !. 
gusErPE singles(I,N) :- 
plus] as I + 1l, 
Iplusl = N, 
Ebdtry(- , liis lg ); m 
assert singles(I,N) :- 
Iplusi is I + 1, 
Iplusl = N, 
not (tbdry lr. (N, 1] pa) ) , 
initbdry([1,N],B), 
assert (tbdry (new, Ctr, (NH, 1], B, [])), !. 


[RRR RR HR RR IR TT RTI TK TTR IIR TR IR TIT IRI KTH HRA KIKI RK HK I / 


a re ees -"next-level-bdrys" subordinate predicateg ******:**».*/ 
E 


Propagate next level bdrys(([]) :- !. 
Puepegate ext Vevel bdrys(([{1I,J]),B1i, (LX, LY))JIA)) :- 


Charny (2, meee), 62, (LX,LY)), /* Previously connected at end */ 


adjacent bdrys(I,J,K,L,I1,Jl,K1,L1), 
not (same (I1,L1)), /* Not same bdry */ 
ordered (11,11,12,L2), 


HoU a 112,12], TEX, DY ld 20). /* Not previously asserted */ 


ordered (11, Jl, 13,13), /* Use indices in order */ 
znasbdrvco[r3.J3],BlFull), 

ordered(Il1,L1,14,L4), 

initbdry([I4,L4],B12), 
bLurentersection(BlFull,Bl2,[IntX,IntY], ,Bl2trumne), 
Witieuolerance (LX; LY, IntX,  inty), 


Getmeerrecl Nalt of bdry (61,682,812, (bX, LY), Bl2trune, {X12,¥12|Blezcor)), 


acaso cl[xL2, 1121 B12cor],B12xXlPast, BI2Vlast), 

gerErountercand increment (Cl), 

assert (tbdry(new,C1,[12,L2], [DX, LY] B12cor], (B12X1ast, B12Y1ast])), 
propsgatesnext Jevel bdrys(A), !. 


propogate next level bdrys(|[([I,J],B,LFt] 1A]) m /* Disregard bedry which is */ 
peenesexnext level bdrys(A), !. /^XpaspcdaepUhcanother bdry or */ 

/* intersects a region edae. x 

puxpoustesnocteDvelobdreyvo(tf[r,J],BP1,|]] IA]) <- ZxIDSseregargd single bdry */ 


Prepedsace Next level tadrys(A), !. 


26] 


get correcte NS bdry CIO Y TIBI], [X27 Y29B2] 0x12, Y U2 EHUENS 


[Xi,Yi],B12tr, [Xi,Yi|Bl2corr]) :- /* Intersect a line from B1 */ 
Xltest is Xi+((X1-X1)/20), /* to B2 drawn just inside their pt of*/ 
Yltest is Yift(itIl-v1)720), /* intersection, with the new bdry. */ 
X2test is X14((X2-X1)/20), /* If no inters, bdry is outside B1 */ 
Y2test is Yit((Y2-Yi)/20), /* and B2, so this is correct half. */ 
not (bdry intersection exact ((AAtest vYitest xX2test, ecos, ee 
reverse path list(Blltr, [| _ , (ieizcomm)) )!- /* but reversed. a/ 

get correct half oT NOR (Ei ee, 
[Xi Yi]; a [X39 X Bog herhabf)) /* Otherwise get the other */ 
reverse path list(Bl2,Bi2Rhev), /* half of new bdry. */ 


bdry intersection(Bl, BlIBRey e No 
reverse path list(Bl2trone, | Mere nac IE 


get active bdry Serim 
tbdry (new, ,[1,J)],B1,LPt1), 
intersect with candidate bdrys(1,J,B1,LPt1), 
fari r, 

get activeSbdgr usc 
retract all and rtn shortest tbdeys(Shortbarys | 
while changing reassert tbdrys(Shortbdrys,1, ,-), 
reset last pts, 
get tburys (A) ME 


intersect with candidate bdrys (IA Ad BUE CS 
get tbdryIJorJI(F, ,11,K]/B2/BBE2 
not (same (F, temp) ) , /* not a temporary bdry */ 
not (same ((X1,Y1],LPt2)), /* not a child of B1 a/ 
ordered(I,J,11,J1), 
ordered(I,K,12,K2), 
not (same ([Il1,J1), [I2,K2})), /* not the same as Bl a 
interior intersection([Xl,Yl|Bl],DPCI?B2 LPt2,;IntPt, Bitoeunc EU 
not (asserted tbdry([I2,K2],IntPt)); /*TINBIM DECGESESPES UP 
get _ counter and increment (COIF /* the candidate, then */ 
assert(tbdry(temp,CO,[I2,K2],B2trunc,IntPt)), /* assert both as temps */ 
not(asserted tbdry([Il,Jgl],IntPt)])]; /*if notwssertecdu 
get counter and ancrement(cijg 
assert (tbdry (temp, C1, [11,01 ),eltruneainere)), 
fail ie 

intersect with candidate bdrys(i, 372 MEUSE - = 
get thdrvyigordi(h, [J LB ERTA 
not (same (F,temp)), /* not a temporary bdry ie, 
not (same ([X1,Y1},LPt2)), /* not a child of Bl =, 
ordered (iat, a i), 
ordered(J,L,J2, 12), 
not (same ([Ił},J1]), [J2,L2})), /* not the same as Bł 2d 
interior intersection([X1,Y1|Bl],LPt1; B2, DP, TOMPCOBUERDIIGOUBZIE TIC 
not (assérted thdry((J2,L2)7intert)), /*1t Bl inter see 
get counter and increment (CO), /* the candidate, then  */ 
assert (tbdry (temp,CO, [J2, L2], B2trunc, IntFt)), /* assert both as temps */ 
not(asserted tbdry([I1,01],IntPt)); "^ii not assemble m 
get _ counter and increment (C UF 
assert (tbdry (temp;C1, [I1, J1], BIC r0ne, TEER 


fal LA 
intersect with candidate bdarys (1 IAE :- /* Intersect bdry with */ 
regiones ea /* region edges. a 


truncate bdry and edges([1,J}, [IXI YPI R 


asserted Eor a MEE /* tbdry is already asserted */ 
tbhury LEE Ns 

asserted ibd ya UM /* tbdry with appx= last pt */ 
thdr Ca JO), (Ma 20), /* is already asserted */ 


wichin torerance (Xil frr, Xi2,Y12) NN 


retract all and rtn shortest tbdrys([([([(1I,J],BminD, LFtminD] |Rest]) :— 
PA (levi, YI, /* Retract all IJ bdrys */ 
retract 1) bdrys(1,J,Bdrys) , 
get shortest tbdry(Bdrys, ,BminD,LPtminD), 
reuractoallcandéertn shortest tbdrys(Rest), n 
memct- all-and rtn shortest tbdrys([]) :- !. 


mactcorgsburys(l,Jg,[[[X,YIB],LPt]|Bdrys]) :- /* Retract all bdrys with */ 
retract (tbdry( Peli, gtx, YIB),LPt)),” /* inglex I,J, and return */ 
retract IJ bdrys(I,J,Bdrys). /* them in a list */ 

ExractcrJ bdrys( , ,[]) :- !. 

xretract IJ bdrys(I,J,X,Y, ([[X, Y| B), LFt ] I Bdrys]) *- /* Retract all bdrys */ 


Perroace (ebdry(, -(1,J3),(X,YIB),LEt)), /* with index I,J which */ 
petrace Iv ebdrys(1,J,X,¥,Bdrys) . /* have same starting pt */ 
peras eta bdrys( , , » + 1)) :- !. /* & rtn them in a list */ 


Ha nortest tbdry([1],100000, , ) :- !. 
Buetushortest tbdry([[B, LPt]|Bdrys],NewMinD, NewB,NewLPt) :- 
path length(B, D), 
guecEshortest tbdry(Bdrys,MinD,PBminD,LFtminD), 
get minD and B(D,B,LFt,MinD, BminD, LPtminD, NewMinD, NewB,NewLFt), !. 
get minD and B(D,B, LPtB,MinD, BOO A BRmiaD,D, 2, LPtB) :- D < MinD, !. 
get minD and En DIBO BDPUtBAOMInD,BminD,LPtminD,MinD,BminD,LPtminD) :- !. 


LNEcESchangang reassert tbdrys(Seti,Ctrl,Set2,Ctr2) :- 
na ce Econmectedotbdrys(Setl,Ctrl,Set2,Ctr2), 
nottsameeset(5eti,S5et2)), 
while Changing Lpasscertathbdrya(Set2o,Ctr2, , Je l: 
while_changing_reassert _tbdrys (Setl, Cerise set2. Ctr2) s- 
same set (Set1,Set2), n 
zu Schangaing9reassert tbdrys(Setl,Ctrl,Set2,Ctr2) :- 
write to screen('Error Zne-rcagsert tbdrys- '),nblb,! 


uIsscrtoconnected tbdrys([],Ctr,[],Ctr) :- !. 
Rl -rItoconnected tbürys([tII,g],B,LFt][ActSet],Ctr,InterjorBs,Ctr2) :- 
connected to an anchor ([I,J],B)}), 
ördered(I, J, K, L), 
agcemetbarvw(eld Ctr, (1,3), B, LPt)), 
Cplus1 is Ctr+l, 
reagserticonnected tbdrys(ActSet,Cplusl,InteriorBs,Ctr2). 
mouuscert connected tbdrys(EE[I, JJ, B, Ft] lActSet],Ctr, 
(I1, J], B, LFt]lInteriorBs],Ctr2}) :- 
PcogggortaconnecpcdEBbdrysInet5et,Ctr,InteriorBs,Ctr2). 


sosnected to an anchor([I,J],BO) :- /* Bdry starts et a region edge */ 
adjacent edges (I,J), ' 

Eunectedoto an-canchor(il,J|, [X1,Yl]B]) :- /*_ Bdry starts at last pt of */ 
Ebay te, wattage, 22, (Xl, YL), /* another anchored bdry. oy 
connectec Eovan vanchor ((%,b],82), !. 

connect anto tan anehñor ( [1,3], [X1,Y11B]). :- Vemeory startscat first pt of "/ 
EE UE L)-bLxloYxr]e2]. /* another anchored bdry. xy 


conect edito lan anchor [KL], B2), !. 


Aa a a a a a a a a a a a a a a aaa a a a a a a e a aa a a a RARAS 


EA OK "done" subordinate predicates A AEA RATRAT 
MOI A A E EE 


Pe otiesample tree fact (indented for clarity only - root is at left): 


Enc e], tExXeet[7,2],  tree([?,11,*1]*,*[)]') 
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recia Irn 
tree([2,3), ^0) OSO 
tree ((3, 7], /tree((3,4),° IS 
== LARA tree tul 1 INS 
tree([5,7],tree((5,6)],'1 
[ 


, ZEE 
tree([6,7),” [ 


J E 
Jet] 2399998 


f 
, 


(7,3) [3,7] 
/ \ / B 
[7,2) (2, 3] [3,4] (4,7) 
/ \ / \ 
[7,1] [1,2] [4,5] [5,7] 
/ \ 
[5, 6] [6,7] hy 


one _ bdry_tree(([[1, J] B; CPE] NANE 
abolish(tree, 3), 
number of edges (N), 
assert leaf trees(1,H), 
while changing combine trees (N), 
number of trees(NT), 
NT == 1, !. 


while changing comeine lt recs (ij ] 
abolish(number of trees,1), 
asSert (number torrtrees id 
retract (number jot trees (Ere viirin 
combine trees (N NT), 
assert (number of Erees{(NIIE 
Previ -mN E /* fails here until no longer changing */ 


combine trees (1; NN, Numiree =). 
TE 
tree ([I, J], Leftl,Rightl1), 
tree ({([J,K],Left2, Righħht2), 
not (same (I,K)), 
succeed if Joined] E]; 
retract (tree (II, J Lefel Rig 9. 
retract (tree([J, K], Left2,Right2)), 
assert(tree([I,K],tree((I,J],Leftl,Rightl),tree(|JMK]) Left2NBExght2))]07 
Iplusl is I 4 1, 
combine treesí(Iplusl,H,HumTrees), !. 

combine trees(1,N,NumTrees) == /* Final case, where tree((I,J],,) */ 
tree([I, J], Lefti, Righel); /* is combined with tree([J,I],,) il 
tree (1) A GeteZz RIgh), 
not (same (Leftl, Left2)), 
succeed if joined(I,J,1), /* TEMP: alwaysSWsMbEceeda 1 1 cU Si 
retract (tree([1, J] Left Righel), /* succeed for center-s/c */ 
retract (tree (IST CEC? Rache 
assert (tree([{I,I],tree({([I, J], Left1l,Rigbt1l}, tree([J, T Lere A 
count “Crees (Nur) reese 


combine trees rM /* Last iter. of while-changing loop, */ 
tree ([|I;T)]asbeftl]1baghtl)ss" /* where single tree is tree((I,I],..) */ 
combine trees (IPP Nuni rees): 
I are 


Iplusl as iti, 

combine trees (iplusi, N,;Numireés) ye 
combine trece 

tree([H,J],Leftl,Right1l), 

tree([J,HKl beftz2 Rright2), 

not (same (HL, EK) ) , 
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suceeguerf Joined (N, J, Kh), 
retract (tree([N J], Lefti,;,Righti)), 
retract (tree ([J,K],Left2,Raight2)), 
assert (tree([N,K],tree([N,J],Leftl,Righti),tree([J,K),Left2, Right2))})), 
SO eca Num rees) amn 

combine trees(H,N,NumTrees) :- /* Base case for all but last iteration */ 
EountEtrecs(NunLrees), ! - 


count trees (Num?rrees) aS 
abolish(count,1), 
assert (count (0)), 
tree( , , ), 
retroct Peut (Count (C)]),; 
NunTrees is C + 1, 
assert (count (NumTrees)), 
fai el. 

pun Ntrees(lHumIrees) :- 
retract (count (NumTrees)), !. 


Meee Leaf trees(I,N) :- 
lie Hi 
Motus os I + 1, 
assert (tree([I,Iplus1), I), [])), 
assert leaf trees(Iplusi, N); L. 
deeri leaf treeg (N,N) :- 
A AA A « 


EN ucceeds if bdrys I,J , J,K , and I,K are joined at one point */ 
Engecedoif joined(I,J,I1). 
museeed 1f joined(I,I,J). 
muameeed if joined(J,I,I). 
ecceed if joined(I,J,K) :- 
Seaered(l 2, 11,J1), 
reve tlio), (X19, 12 B17), (LX19,Y29)), 
ordered(J,K,J2,K2), 
o IA SS SAS 
Ordered(I,K,I3,R3), 
endre e (T3 K3), [Xik, Yik]|Bik], [LXik,LYik]), 
A si Yip, Gx, bLYagj, Xk, Yj, bXgh, LY jk, Xik, Yik, LXik, LYik),!. 


/* Succeeds if there is a match among any permutation of the three */ 

eS Of points; First check for exact matches: */ 

aaO PES (X, Y, AY, Qo ,X,Y, X, ). 

motel 3 pts(_,_ ,X, DENEN ATE r. lu 

IR OS PESA a r y RY, X, Y a). 

Macia PESO) TX Y, + 1 Ar YX, Yo _ )- 

puce pts(X,Y, x Ae enu 

MAPS PES UP X.Y,M,Y, , , , XY). 

miten pts(^,Y,os, , , ;XoYo , ,2X,Y). 

Nate PES, o rn (XY). 

/* I£ no exact match, check for approximate matches: */ 

E A II, AZ 2 .K3,Y3, , ) :- 
Potiimebaterance(X1,¥1,X2;¥2), E 
"tbsuEtolerance(X1,Y1,23,Y3L, 
szrtbsnareMerance(X2,Y2,X3,Y3), T. 

ORI SI LL, AL Ll , ,53,13,., ) :- 
pi rele cence 1x1, Y1,X2,Y12), 
A rance (xl, 11,X3,Y3), 
vu clerance(X2,Y2,X3,Y3), !. 

match sspe NU XNéNLY2, 2o. (6 ^53,Y3) :- 
qubsPolerance(XJl,Yl1,x2,Y2), 
waa ISrance(XL,Yl,X3,Y3), 
Wicho te rance (X2, Y2,X3,Y12), !. 

IAS COPIA A A os AA YA) 3 


~<] 
«| «il 


"d 
- ow 


f 


=< | 
x 


IAS 


within tolerange d rp xa aj 
withinotrolerance(15Y1,70Y3)7 
within tolerance 112, X3, YO 
match 3 pts(XL,.Yl., , eee 3, ML 
withiznctolerance db nl PN 
within tolerance) 1 113,021 
within tolerance (22 Y2 
match 3 pPtSs( : X O A) 0 
within tolerance Y1 X2 Y2}; 
within tolerance (XIXI X3 ra 
within tolerance (X2,%2, 33, 3 2i3 
match 3 pts(Xl, Y pip X2 E o 
within tolerance(X1,Y1,X2,Y2), 
within tolerance acl Yr X313)? 
within tolerance (X2, Y2; n3 3): 
match 3 (pis (7, Ai ey ep) op T 
| within tolerance(X1,Y1,X2,Y2), 
within toleramcelxl,YL, 3x5), 
within toleranse (22,12. 53-18), Ue 


f Nh h hok de X x e C e x M kk Ax AAA RARA RARA RRA RARA ARA ARA AAA 


/[^**^***** Melim incomplete trees” subordinate predicat oE wae 
f * Nh hh ^ hh x A e I e e A UA I heh ee eh Kk Ro I III UA 7 


/* Succeeds if top node of tree is anchored to an edge by means of */ 
/* an edage-intersection. Tf 30, the Greens) complete since » Jd 
/* each leaf node is anchored by means of a region vertex. i 
complete tree (trec pn UU Emp 

ordered (JJ TUIS Ii; 

tbâry (aer IE IIT XB DEP 

edae bdry intersectron(.; | Db DEC 
complete tree('tree( [m dI DUREE: -— 

ordered(I,J,I1,dJ1), 

tbdry( ; , [134 X EBI, CEEI 

edge bdry 3mntersectron(o V D DI PI IDEEN 


/* Retracts all bdrys associated with nodes in 'tree' */ 
eliminate trees MD 
eliminate tree (Clbdry a(t ee ieee eee 
retract succeed (lree( (i, 0) a eer 
ordered Ii 
retract succeeatiiaavy(:,., (lL, Je ae 
eliminate tree jebanys (Lb), 
eliana tener cada), ue 


[ARERRRARRARARARRA RARA ARA RA RARA RARA RARA RA RA AAA RARA NAAA RARA AA RARA RAA A Y 


[*******»*** "fipd exact opp pt” subordinate predicates e 1 111ll l 
[AERRARARAA RARA AAA RRA RARA RR RARA RA AAA ERA ARA ARA ARA AAN KDE E 


update op» educ pr Jg dnx ACUC), AZ 12 MOSS 
opposite edge(OE), 
update opp edge2(I,J,([LX,LY,c(C), X2: 02 |OP IS 


update opp edgezZ(i,d, [LX, LY, c(C), X2, Y2 OF), |Xa, Yap D TEL 
on Line ta a) 
Eetract(oppospEessse (OBO) 
update opp edge3([LX,LY,X2,Y2], [Xa, Ya] ME DOE TIE 
auusrt(opposcctEedge(OoEl)), le 
update opp edge2(I,J, [bX,LY,c(C),X2,Y2|]OF]; (2 AM ee = 
update opp edge2(I,J, [LX, LY, cC(C) X222 eee ee 
update opp edae2(1,J,[LX,LY,c(C),X2,*20 0D] BOUM 


/* If OF is counterclockwise along opp edge: */ 
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paste Opp, eqge3((LX,LY,X2,¥2), |Xa,Ya), |Xa,Ya,H,Xb, YDIOEO]), 
arna o) X Ice Ux, LY ,H, Xb, YDIOEO]) :- 
on ray (X2,Y2,LX,LY,Xa,Ya),!. 
L* If OP is clockwise along opp edge: */ 
update opp edge3([LX, LY,X2,Y2], [Xa, Ya], [Xa, Ya, H, Xb, Yb| OEO], 
xara be (ca x2 12. h(0),Xb, Yb)OE0]) :- 
on_ray (X2,Y2,LX,LY,Xb, Yb),!. 
/* Xf OP is neither clockwise or cew then it goes into HCA interior or it */ 
/* goes toward goal into HCA exterior, so it says nothing about opp point */ 
update opp edge3([LX, LY, X2,Y2], [Xa, Ya], [Xa, Ya, H,Xb,YL]OEO], 
Ica gH xb YbIOS0)). :- !. 
/* If LX,LY is not on current opp edge segment, recurse to next segment */ 
B dutecopp'edge3([EX,LY,X2,Y2], [Xa, Ya] , [Xb, Yb, H| OEO0] , UXb, Yb,HJOE1]) :- 
not (same ([Xa, Ya], [Xb, Yb])), 
ppeatesopp-edge3([EX,bY,X2,Y2), [Xa, Ya], OEO, OE1), t. 


[FARRO ARA RARA RAR ARA RARA RA RARA RRA RARA RAR AA RARA AAA 


NEEUS***^**** "update opposite edge" subordinate predicates  ********/ 
[ARRAY 


INE N Opp pl finds a new (& correct) opposite point if one is XJ 
END Sesent cor rtns orig opp pt. If it recurses thru whole list  */ 
ac hilo) for each edge, initial opp pt was good. If it hd 
/* finds a label other than h(o), then it needs new opp point. S 


pogNopp PE ,.[ , ,h(o), , ],[Xopp,Yorp]) :- 
opposutesponnt(Xopp,YopPp), !. 

DEROP PE o, (X1,Y1,h(o),X2,Y2|OE],F) :— 
nee ppp IEX, Y2 10E], P); !. 

eP PEI  [X1, Yl, h(ccw), X2, Y2, ,X3,Y3),P) :- 

TZ "optimal path([X1,Y1! ],Cccw), 

oe bisection search(X2,Y2,X3,Y3,Xcw,Ycw), 
optimal path(|Xew, Yew] ],Cew), 
ALG norPare( nl, Yl, Kew, row, Cccw,Ccw,P),; !. 

MSNM pepe ((X07,10], (X1, Y1,h(cw),22,Y2|_),P) :- 
optimal path(1X2,Y2| ),Ccw), 
Some ocean dearcl) (x), Y1,X0, x0; Xccw, Yecw) , 
Pee wna le pach (| ktecw, Yoow|..},Cccw) ; 
COSXCESODDEptO0X20Y2,Xccw,Ycew,Cew,Cccw, P), 1. 


EM cctoiondSearch(X1l,Y1,X2,Y2,X,Y) :- /* Bisect edge; compute OF */ 
eo te X2—-% 1) 7/2, /* from midpt; if OF starts” / 
Us (Y2-Y1)/2, ¡a tóna tease ehis is the */ 
round to 4decpl(Xi0,Xi), M point we are looking for*/ 


noundeto'ddecpr tyr Yi), 
optimal path Mea Ya E CIA OB), 
COME, 1d, 2,12), 1 


pexpacctaon search(Xl,Y1,X2,X2,X,Y) :- /* If OP does not start on 
Aa LA 7(X2-X1) /2, /* edge, search between 
Yougers Yl - (Y2-Y1)/2, joe wine and point à. 


mouncdmeco 4decpl (X10,%1), 
roundacco4decpl(iYi0,Y2), 
noscccmnmetolerance(X1,Y3,X1,Y1)), 

cg csectomesearch(XI,Y1,X3,Yi,X,Y), !'. 


uNLcdcectosméasearch(Xi,Yi!,X2,Y2,X,Y) :- ANO correct OP 13 
ASA (%2-%1)/2, i found, return Ft 1 as 
Y? 1 1/2, /* answer. This case 
cols cane xi, Yi,Xx1,Y1), /* SHQULE NOT HAPPÉN, so 
colina Ops), M print a warning. 
write('*Need OP for start-point '), 

Pia, ,11)),n]1, 

teliliuser), 

write (‘WARNING: missing optimal path from opposite edago'),nl, 
write (’ forcpredicaue WolNEDiScectacousSsearch'''),nl, '. 
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[ARRBARRRARARA RARA AR RRARA RARA RRA RARA RARA AAA RAR AR RARA RARA AAA RA ARA RAS 


[ARARNAR EEA "evtpiuer. subordinate predicates khhkk hhh kkk kh kk ke / 
f hh he Ne A Gh e e e e ook RA RARA RARA RR RARA RANA ARA RA AAA AAA ARA RA LE 


write bdry3 to t1le heroe 

write bdrys to £ile(Mecscopm (TNA GC) Raryset |) as 
tell (hca_ opm), 
Write ("bdnuy(‘), 
write([I,J]),write(','),write(B), 
wriee (jg uns 
write bdfys to file(hcatopm BdEySer)s 


write mter to SC Crec DE 
retract (number of iter(I)), 
Iplus] is 1 +212, 
assert (number of aiter(I1minsl))s 
tell(user), 
Write (’consistency check ’), 
write (Tl)? npo 
write heading 
region vertices (Ui EIUS goal point (%g,Yg), 
cons (X, YIR]; [X,Y], Regioni, 
tell (bento 
listing(title), 
write (‘ region(’),write (Region),write(’).’),nl, 
write (‘goal ([’),write (%qg) ,writeC ,"), wette (gq 0 a, 
listing (tree), ee 


~ 


write Eopacree (7 = 
Lell (user), 
write (Xx) nl, 


[Artt UU Ah e e ON Oe e e RARA RARA RARA e eh e eh e e ee e RO e e e à kJ 
[RRR RRND WARES EA A utility predicates OO e e e e e e e RRA x à 


f NONOUI Uh AU OO e e xe Ae e e e e ee e OR ORO 0e RR e eR A / 


/* Succeeds if line segments intersect, but do not share an endpoint. */ 
interior intersection((217 7) )B1), Lrtl, (X2, ¥2|B2), LFU2, inet eee) 


not (same (LPt1,LPt2)), /* If inters at endpt, fails; if mote 
not (same ([>1, Yr). (%2, ¥2}))), /* and intersects somewhere, succeeds*/ 
not (same ([X1,Y1],LPt2)), /* Assumes Bl & B2 intersect 


not (same ([ 42, ¥2}), LEt lj) /* in at most one paint. 
bdry intersection ([X1,Y1|B1), (X2, Y2|B2)], Int Etr B -EE Au 


interior intersection((X1,Y11B1]),11,1%2,Y21B2]) (IDE CAB c. AIMN 


bdry intersection([X1,Y1/|B1),[X2,Y2/B2] 10860 PTE OS 
J ATE letboar ys * 7 


* ‘bdry intersection’ determines the intersection of two boundaries, 
* or fails if there is no intersection. The boun arie siare 
piecewise linear,and are represented as a list of points, 
* ie, [xl,yl;x2,y2,x399 9929] m tolerance 6s agde 
* Once an intersection is found, it is cached to speed up future references 
bdry intersection qp oe D BULtI2 B2 Tr 
bdry intersection] (appx, Bl, B2, [Xi Yil E eer ne) 
412 38g. C£Joor(x42*)70000) /L0000)2 
Y12 is (floor(Yi^10000)/10000), 
replace last coords(Bitrunc, [X325 0] ME 
replace last coords(P2trunc, [X329 ee eee, 
asserta(bdry intersection (Bl, 62) ape A D 


2/5 


y intersection exact” 135 like 'bdry intersection', except that 
* no tolerance is allowed on intersection point being interior to 
* both bdrys, and bdry intersections are not cached. */ 
EN xutersection exact (Bl,B2,[X22,Y12], Bltr2,B2tr2) A 
o e eC exact BIB [Xi, Yi], BI1trunc, B2trunc), 
Mize is (Eloor (X1*10000)/10000), 
Yi2 is (floor (Yi*10000)/10000), 
deplace last coords (Pitrunc, (X12, Y12)],Bltr2), 
mnupniagce last coords (B2trunc, [X12,Y12],BR2tr2),!. 
/* Check if any segment of bdry 1 matches the lst segment of bdry 2. */ 
EE ersecEronl (Prec, [X11, Y11, X12, Y12|] B1], [X21, Y21, X22, Y22| B2] , [Xà, Ya], 
Eltruunc.Bztrunc) :- 
RExcenter»ectaion2(Prec, [X11,Y11, X12, Y121|B1], 
EXE ESI x72Y22]. [X1.Y3],;BliErunc,B2trunc), !. 
/* Recursively check the next segment of boundary 2 with all of bdry 1.  */ 
NEIN .rsectionbFrec, X11, Y11, X12, Y12|B1], (X21, Y21,X22, Y22]| B2] , (Xi, Yi], 
ENpEuncsIx21,Y21|B2trunc]) :- 
put crscectronb(Preco[X1Il,Y11,X12,Y121]B1], 
E 27) B72) kr, Yi), Bltrunc, BZtrunc), !. 
/* Recursively see if any seg of bdry 1 matches the lst segment of bdry 2. */ 
Ex umntersection2(appx, [X11, Y11, X12, Y12|B1], 
BEES» Y22]»[X3,;Yxr],[Xl1,Yll,Xai,Yx],[X21,Y21,Xi,Y31]) :- 
NIME nPEE3ecDLOmQOUTI YLl]I,X12,Y12,X21,Y21,X22,Y22,X2,Y3), 
between (X1,X11,X12), 


between(Yi,Y11,Y12), /* Check if pt i is between * / 
between(Xi,X21,X22), /* endpoints of both segments */ 
between(Yi,Y21,Y22), !. /* inclusively i 


px ubersection2(appx, [X11,Y11,X12,Y121B1], 
IE Y22],. [Xi,Y3], [X11], Y] | Bltrunc],B2trunc) :- 
po ntersectiyon2í(appx, [X12, Y12|B1], 
EU 0T xr vY22]X1 Yi] BItrunc,B2trunc), !. 

pte rsectionz (exact, [X11,Y11,X12,Y12/B1), 
PA a a A ATTE, Xi, Y1)], [X21,121,X1,11)])) v= 
¡nc ers econ (11 Ao le 121, Y21,X22)Y122,Xi,Y1), 
eaace between (xXi,X11,xX12), 


trgcemEetween(ri YllY12), /* Check if pt i is between E 
= actmet ween (ka ,421, X22), /* endpoints of both segments */ 
ExcerEbetween(Y1,Y21,Y22), !. /* inclusively ve 


Ae rsectionz (exact, |X11,Y11,X12,Y12|B1], 
AZ, 1221, 1X1,Y11],[(X11,1111B1trunc],B2trunc) :- 
Ni intersection2 (exact, [X12, Y12]B1], 
Inu 2 Y 27) (45, Xi}, Bltrunc, B2trunc), !. 


pace last pcoords(| , J,1X,Y)],1X,Y]). 
acen lasticoordai([X1,Y1]L), [X,Y)], [X1,Y1]L2]) :- 
mcpIcGccElastoecoords(b, [X, Y], b2), t. 


ARE y TITO EII AE,C, (1,],B,LFt) :- thbdry(F,C, (1,J3],B,LPt.). 
HN VIJoOLJL(E^C,I[I,J],B,LPt) :- tbdry(F,C, [J, I], B; EFC) . 


neasscdstotndrvsm(E,[],Ctr). 

El eta (1, 4], B, LPt]IA3],Ctr) :- 
aooemenuemdry (Fr, Cuxy, [1,J0],B;, LFt)), 
G7 vege ty 4 1). 
peausestatburys(F,A3,C2), !. 


seee onda ces (1111) :- !. 

EA AB, LP] [Rest], [[(11,31],B, Lt] [|RevisedRest]) :- 
Ordornosir JJ. Il,JIl1), 
cias (Rest, RevisedRest), !. 


adjacent bdrys(1,J9,3, FE, I,9 
angie bir ai, i, J, 1, 0,0; FE) 
acaeia@emt! hdrve (id, bv, J, I 


(1 1) ET Ve 
dun 
i 


i 


A 
A 
I 


, m 
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adjacent bdrys(1,J,K, 1, I EE 


adjacent pedges (1,1) T. E is I 4 1. 
adjacent edges(1,/N) :- number of edges (t) 


get instbhbdryIlOJorJdl LB xnitbdresm DB 
get initbdryIJorJI(I,J,B) :— anabbdre A 


get tbdrys 
assert (bdry list(1])), 
bd e es lee ee 
retract  cutibdr aati 
assert (bdxry Just [LL T, JI BA DECRE 
fail. 
get _ tbdrys(A) == retract (dry ist (hee 


reset last pms /* Insures that intersecting i/ 
B Cbdry (E12 61; UT, 3], e y /* bdrys have identical last points */ 
tbdry(F2,C2, UE, D] B2 EE EY 21) 
adjacent_bdrys (1, J, K, L; TI; J1, KITEN? 
not (same ([1; J] EREI; 
within tolerance (XI, brb p ys) 
retract cut(tbdry(F2.C2P [t MI eo ze 2, uy 2))), 
asserta (tbdry (F2, C2, [K, LE) B27 es ld 1) ,, 
fail TT 
reset I33 ND MOLIS. 


edgeėe adjacent toknadry (TE). 
edge adjacent tolbdry (J IJ}: 


bdry starts at_edge(1,J,J). :- DEAR EGE UDECUUMC 
bdry starts at "edge(1, J, 1) :- Diff TS Pw Gb NN PC 
bdry starts at_edge(1, M1) :- number ofr kedges mE 

bdry starts at edge (1,t,1) :— number ofl edges(N), P 

bdry starts at edge t1) :—nowbe MEN - 

bdry starts at edge(H,l,N) :—- numbergoer ledge 


/* Opp Ft is located proportional to OP costs at each end */ 
calc opp pt (X1,Y1,X2,Y2,CI] A4 CO DXOPpp e 

distance (X1, 1152 DA 

DelX 1s X2 - X1, DelY is Y2 -~ Yl, 

XoppO is X1 4 ((D124C2-C1)/D12)* (De1X72), 

YoppOÜ is Y1 4 ((DI2tC2-Cl)7DT12) ^ Ubedm 2; 

round to ddecp (Op pop): 

round to AdecpI (VOPPU Op l. 


/* Rounds off a number to four decimal places (to allow unification */ 


/* with manually input optimal paths) */ 
round to 4decpl(X,Xr) :- Xr is (floor((xX'0, 00005) 10000 sea. 
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* "bgutils" contains supporting predicates used by the "bg" files. 
* 
* Consulted and called by "bg". 
* 
* 


Updated 12 Jan 89. 
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/* CONSTANTS: Dimensions of input map */ 
minx (0). 

maxX (80). 

miny (0). 

maxY (100). 


pus 14159). 


/* "precision" is the max number of line segments to compute */ 
/* for each ivis boundary, and twice the number for 2vis boundaries.  */ 
precision(20). 


tolerance (0.05). /* Pts closer than this are usually not distinguished */ 
/* tolerance (0.015). */ 


ELE Ue OA URORONORO KON K AA OK OK Ok AK Ok Uh CAU hok hh AJ 


f hU e UU e general utility predicates RARA A e e UU A x à Gà / 
f 8 RON I e M e e he he e e e e e hehe e he e eh e ee ehe ee e ehe eh he e e e 0 e e e e A0 e e e v 


between(B,A,C) :- 
tolerance(T), 
Hpbustrs B! I, 
|RSS cT 
A =< Bplus, 
porscecolus;- t. 

between(B,A,C) :- 
tolerance (T), 
Bminus is B - T, 
Gm»snussisg C - T, 
A >= Bminus, 
B >= Cminus, !. 


ERoact DOE Ben B,A,C) :- 


A =< B, 
DESL NU 

endo. Detween(B,A, €) :- 
ncm 
B >= C, ! 

Seater lyebervecen(s,A,C) :- 
AaB, 
Duc t, 

Sipe oul sbeewecei (Bb, A, C) = 
A> pP, 
BG, t, 


gepecounsccdNncremenL(Cctr) :- 
E@igmact act r(Ctr)), 
ELS Ctr- I, 
agunt ri plusl)), l. 


ordered J T J)a 
ordered(1,J,3, 141 Mn 


— 
li 
A 
g 

~ 
— 


aba (X; X) ~ X >n. 
¡O E A. 


abs(X,Y) :- X -« 

retract succeed(P) :- retract (P), !4 /* Always succeeds mra MES Eu 
a A o an 

retractacut (P) i- retrati EE /* Retracts P, fails on backtracking */ 
unify cut (D) eal /* Geta lat inotance of P, fails on backt rackandad s 


/* fails the first time called, then succeeds, toggling thereafter */ 
fai] succeed :- not(failed), aggere eked) HIE 
fai] succeeds = failed, retract (failed), !. 


get lastlpegi last, 1)o6t) {lasts age). 
get last pe([x, ¥| Rest Peasant, lace = 
get lastopt (Best, lasted) 


get last (list (last | ease 
get last ist ((F |Pes. tetas = 
get Vast last Rest base 


within tolerance (irr 2) t 
tolerance (Tolerance), 
DelX is X1-X2, 
Delx < Teramee, 
DelX > -Tolerance, 
DelY is Yl-Y2, 
DelY < Tolerance, 
DelY > SToléerance, !. 


same set (Set ae 
same (Set1,Set2), !. 

same sete crea 
match and delete (A Sep sepas 
same set (Sell, Seco ya E 


match andidelete (ia age 

match andpdelete (2 |) | Rese areac)s 

match and delete (A, (B| Set) eiseelcaan ees 
match and delete (A, Set, SetLessA) . 


/* input: starting and ending integers */ 
/* output: list of lists of the form (11,2 12 I) lee 
/* where an index pair appears the num of times its initbdry appears */ 
index Tist Ibo M c e 
index. list Tor II AE AS 
= Iplusl Tg hs ! 
index _ list_ItoJ(iplus}, J, Rest), !. 


/* returns the number of initbdry([1.J]1 29) 2803990 PEU 
number of SUMI OIM nE a 

assert (temp mm0) y, 

init ode O 

retracrpuacots emp numis 

Vplual is K+}, | 

as caen iio lps 110 

¡E 
number of a) 

retract cul (temp nur (1H)), Ll. 


INE O J-element bdryelrs.s of form ([[1,2)],B1,LPt1],...)] */ 
/* output: list of lists of the form [11,2],12,3],...] where each */ 
ye bdry in input list is represented by its index list a 
Me: Isst({},{)) :- !. 
meee ist ((([1,J),_,_])|Rest],t(1,0]|RevList]) :- 

index list (Rest,RevList), !. 


/* input: Num of edges and list of indices of each bdry previously asserted */ 
Pemoutput: list of indices of each bdry not previously asserted */ 


Somebement index list (N,{{1,2]|InList],OutList) :- ¡“TES see sit */ 
comp Nus Inbist,l],OutList), !. 
Semplement index list (N,Inbist,OutList) :- Veet MMS not first. */ 


complement index list1(2,H,InList,[i1,2]],OutList), !. 
fort 11,2] is first OR last, do not include it in complement list */ 
METE 11,2) is neither first NOR last, include it */ 
complement index  listl(H, PE rtarsct,TrtiIN,l)WMESESt]) 2— E 
complement | index EnuSUCUOM UU lpgpEairst,tarst) <= p 
complement index Lit Li we rrr2]],E&Eirst,L(H,1]])) :- !. 
eel ement index listl(H,s,t[8,1],[1,2]],First,[]) :- !. 
complement index lkistl1(1,N, 111,7) |Rest]),First,RevindexList) :- 
Iplusl is I + 1, 
eomeeemem. index Isstli(Iplusl,", Rest,First,RevindexList), !. 
tenencias 11i3t1(1,N, [(1,K]|Rest), First, [[1, Iplus1)|RevindexList]) :- 
AUS is I + 1, 
not (same (I,J)), 
come ement index listl(Iplus1, N, [[J,K]]|Rest], First, RevIndex JS a, 


ebe ract ronn, [], L) := !. 

os ubDtraction(Ll,(A]L2],L4) :- 
deleterfrom list(A, L1, L3), 
set subtraction(L3,L2,L4), !. 


gc cesrromnm Jist (A, 1), (J)) :- 1. 

deete Erom list (A, [AL] ,L2) :- 
delete from list(A,L,L2), !. 

delete from list (A, [BIL], [BIL2]) :- 
deke ecmerom list (A,b,L2), !. 


T 
* predicates related to rotation and translation of the boundary. 


i 


compute angle of rotation(Xo,Yo,X,Y, Angle) :- /* Computes angle to rot.*/ 
^ pelX is X-Xo, /* the x-axis to the Af 

betes >> 0, V eer orl (XO, 1o)—-> (X,Y) Y 

belY is Y-Yo, /* when the anale is a 


ames —-agin(DelyY/sqrt (DelxX” 2!DelY~2)). /* between -pi/2 & pi/2, */ 
Eougputeususesof rotation(Xo,Yo,X,Y,Angle) :- 


ely eis Y-Yo, /* ...when the anale is */ 
LEES Y >= 0, A between pi/2 6 pl. E 
Del ES X-XO, 

pi (PWY, 


Angle is -Pitasin(lDelY/syrt (DelX¥*2tDelY%2)). 
computeraar rotation (Xo, Yo, X, Y, Angle) :- 


pos Y-Yo, /* .. MAMAR Remal is */ 
Dod, /* between pi & 3pi/2. a7 
DelX is X-Xo, 

pass 


Anglo is Filasin(DelyY/srrt (De1X^21De1Y^2)). 


o /* Peflects the boundary bid 
retract (bdry (P.)), J* “about the vertical lime '/ 
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Invert bdxy (p saree), /* X=Vx, where Vx is the ir 

assert (bdry(R uve. /* bdry vertex or last pair*/ 
invert bdry (1X, Y]: X 2: 0] 0 /$90of£ cesrds amsbdry list +7 
invert bdry([X, YIR] zre r mny, iny e 

invert bdry (R Xren 

invert: -coords (X7x rrer Kin Aee 
invert coords X, Y; Xref Kinu a 

Xinv is 2 Xrell =y. 


rotate buzy Anglen 
retract (bdry (L)), 
rotate bdry (L Angle, , ,brot)s 
assert (bdry(Lrot)), le 
rotate _bdry([X, Y], nale n Y T /* Assumes last item in */ 
/*list is bdry vertex */ 
rotate bdry(IX,Y|L]5Z^Angle xoc ot, NS 
rotate bdry(L, Angle, Xo, Yo, Crem)® 
translate point (X,Y, Xo Yo Xer Tee 
rotate point (Xir tr, Andile SPORIS NEUE 
re translategpogznt(Xrobl irot Io O ner rote 
rotate point(s, Y,Angle, or, TOCE 
Xrot is X*cos(Angle) + Y*sin(Angle), 
Yrot is Y¥*cos{Angle) - X*sin(Angie) . 


rotated bury nde 
retract (bary (TIIS 
rotate2 bdry(L,Angle, , ,Lrot), 
assert (bdry(Lrot)), !. 
rotate? bary (1X ng le, Xx, Y, 1 /* Assumes last item in */ 
/*list is origin of rotation, but not on boundary a 
rotate2 _ bdry([X, YE] Angie, Xo, Yo [rot EORNM PE 
rotate2 bd Angle, Xo o rote 
translate point (X,Y, Xo, Yo, XED rE 
rotate point (Xtx, Ytr, Angle, Xrotl,yrotl), 
re translate point (Xrotl, yrotl, Mojo, rot, roti 


translatelpornt o) ALE) AS 
Kir 91S 0% xo, 
Ytr 15 Y- i0. 

re translate porne X ro TURNO S OU ae 
X xgoXtrixos 
Ys YHP S 


/* 


* 


E 


Miscellaneous utility predicates. 


debug list (fFilenams) < 
tell (Filename), 
laisting(region veptuces),listing(ritie),Isst"ng(gostepoisnt 
listing(Ebdry),1istaing(initbudry) Listungdtbress 


reversetlus o IM 

reverse list (PII Rev eona) = 
reverse Ra StE oec), 
cons (RevL, [X],RevLconsX). 


reverse e A Ys 

reverse ¡Edge list MASA Y Lcon sa aa. 
reversesedoae Jw (IL, Bevb). 
cons(Revb, Hx Y)|2bevLconsx). 
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Beverse path 
eere path 
beverse path 


Reverse path 
Leverse path 


imus Yep) oh. 

¡A dq X2YZ| IXS Y2,.Xl,Y1]) ¢= !. 

emo le lee eer sey), (XS, Y3,X2,Y¥2,X1,Y1})) :- !. 

list ([X1,Y1,X2,Y2,X3,Y3,X4,Y4],[X4,Y4,X3,Y3,X2,Y2,X1,Y1]) :- l. 
list ([{X1,Y1,X2,Y2,X3,Y3,X4,Y4,Xx5,Y5], 


(X5, Y5,X4, Y4, X3, Y3,X2,Y2,X1l1,Yl]} :- !. 


Beverse path 


IB EDU Y15X29Y2/X3, Y3, X4, Y4, X5, 5, X6, Y6], 


[Game oo 5S Xd, Y4, X3, 135 X2, Y2,X1, Y1]) :- t. 


reverse path 


list([X1,Y1,X2,Y2, X3, Y3, X4, Y4, X5, Y5, X6, Y6, X7, Y], 


[XU YJ X6. Y6,X5, Y5, X4, Y4, X3, 3, X2, Y2, X1, Y1]) :- !. 


reverse path 


IEESDEMIEOI Y] X2 122373 X17,Y4,X5,Y5,X6, Y6,X7, Y7, X8, Y8]; 


[X8, Y8, X7, Y7, X6, 6, X5, 5, X4, Y4, 3, 3, X2, Y2, X1, Y1]) :- !. 


reverse path 


Eo e a X20Y27LX3 Y37X4, Y4,X5,Y5,X6, Y6, X7, Y7, X8, YO, X9, Y9], 


[X9, Y9, X8, 38, X7, Y7, X6, Y6, X5, Y5, X4, Y4, X3, 3, X2, 2, X1, Y1]) :- !. 


eeverge path list([X,Y|L],RevLconsXY) :- 
reverse pati list (L,RevL), 
Fons (Rev IX Yl RevbconsXY), !. 


/* Return the point of intersection of two lines, fail if parallel. */ 
/* Note: next 4 rules are included to retain precision where possible. */ 


/* 1£ lines share a point, that point is the intersection: */ 
Ie ES econ (X1, Y1,X2,12,XL, Y1,X4,Y4,X1,Y1) :- !. 
EN crsectron(X1,Y1,X2,Y2,X2,Y2,X4,Y4,x2,Y2) :- !. 
Ian tersection(X1, Y1,12,Y2,X3,Y3,X1,Y1,X1,Y1) :- !. 
Ice rsection(Xl, 11,2, Y2,X3,Y3,X2,Y2,X2,Y2) :- ! 
line BU cHIOHXI,Yl,X2,YX2,X3,Y3,X4,YX4,Xi,Yài) :- 
not (X2==X1), /* Handle separately if */ 
not (X4=3X3), y^ one line is vertical */ 
Ma is (Y2-Y1)/(X2-X1), /* Slope of lst line */ 
Ba is Yl-Ma*xl, /* Y-intecept of lst line */ 
mhb is (Y4-Y3}/(X4-X3), /* Slope of 2nd Line */ 
BIS ASH), j^ Y-3ntecept of 20d line *7 
not (Mb==Ma), /* This happens if lines are parallel */ 
Xi is (Ba-Bb)/ (Mb-Ma), 
Vows tis yy + Bis, t. 
Ice rsection(X1, Y1,X1,Y2,X3,Y3,X4,Y4,X1,Yi) :- 
nortx4--»3)- /* Case where lst line is vertical 
Mb is (Y4-Y3)/(X4-X3), /* Fails if both Lines vertical */ 
Bas 1 3-Mb* xa, 
Xi 319 XI, 
ums tib^x Bb, '. 
A o Sec ion (XL, 11,42, Y2,X3,Y3,X2,Y4,X1,Y11) :- 
not (X2==X1), /* Case where 2nd line is vertical 
Ma is (Y2-Y1)/(X2-X1), /* Fails if both lines vertical */ 
EG. 35 YI-Ma*xl, 
2309312 X3; 
nies + Ba, !. 
ux Ere ee Canon; de Yl X2. Y2. X1,Y1.X2,Y2, X1,Y1).. /* If lineszare identical */ 
D'OCpectanethesstewerHieuasSerntessectyen point.^*/ 
BESCMUUECDOCEOGENOHn(OXl1,YlX1,Y2,X1,Y3, X1, Y4, X1, YI) . Case where lines are */ 
Tea coincident: return lst vertex of st line as int pt.  */ 
Ii ce aaron, Y, X1, 12,X3,13,X3,14,X1,Y1) := /* Case where lines are */ 
PE /* both vertical, but motwecorncicdent;: fail. */ 


e er ee anl Y1, X2, Y2,X3, Y3, X4,Y4,X1, Y1) :- 
not (X2==%1), 
not (X4==%3), 


Coincident lines */ 


2 Y 1) /(X2-xX1), /* Slope of l3 line '/ 
Ba is Yl-Ma*Xl, /* Yv-yiynEecept ote lst. line=/ 
OS) / M4 3), /*.Slope of 2nd IYWe */ 
POTS TY EVID, IYS InCECE E Of 2nd line */ 
Hab, / "mEarallely */ 

==Bb, !. /* Same y-intercepts */ 


/* If lines are coincident, return lst vertex of lst line as int pt 


ASE 


E y 


virtual vertex(X1,Y1,X2,12,X3,Y13,X14 Y PS 
line intersection(X1,Y1,X2,Y12, 3 MIRA A A 
/* intersection of the lines. 


distance (X1, Y1, X2, Y2,D) F: = 


D is sqrt ((X2-X1)°2 + (2 


/* Counts length of a list */ 
Ja:stuengEh 950) 
list length([X|Rest],Iplus!l) :- 
y list length (Ress 
Lplusl asc DL M 


/* Computes length of path P */ 
path length([],0). 
path leagte -arna 


path length([X1,Y1;c(C); X2, YZE]; D) :- 


path_length ( [RARA E], DL), 
distance (XT AZ AZ 
D- -igs D1 + CID? Sm 
path-lJengtħ({X1, YI 1 Ze |e a 
¿path Tenge (X2, 2 BDO 
distance (X17 11) x2, 12, 2) 
D is DI FDO? 


/* Computes length of edge P */ 

edge lemoen 110% 

edge_length(( 7 7),0)- 

edge length A ADO 
edge length tlie CoU DI), 
distance (X1, tax. 12; D2), 
D is- DI FID Z 48 


i= 


/* If cost data is present, 
/* weighted cost of path; 


the virtual vertex 13 


find 


/* If cost data is not present, 


/* find Euclidean length of path 


/* Computes the distance between pts 1 & 2 along path P */ 
/* First travels down the path until pt 1 is found +*/ 


/* then constructs list btwn ptl & 2, 


path distance (XI AA ee) 
path- distancaz (X1; Y1, X272, IXI ENE ee, 


pathulengt hrel D) o 


path distance (MATAS ioe ed ee 


path distance (MITA ZA 
path distante d 10S, vara que 


P; Dig 


path distance, AL AA 
path _ distance2 (X1, Y1,X2, Y2 [X37 Y3; c (CHIE x O CI ND NEL 
path distance2 (X1, Y1, X2, 1E DEE 


same (A,A). /* succeeds if both args are the same, 


/* concat arg 2 (atom), onto end of arg 1 


cons (| |) 3, Bp ZI 
cons ([XIB1], B2 IXB; = 
cons (PIVER BI) '. 


(list), return as arg 3 


/* A robust arccosine routine (in C-Frolog, acos(1) 


arccos (X, O - 
x > 0.99999, b s 
arccos (X,B) :- A as) acoso d 


/* Remove the last pair of coords 
remove last pt (la, A 
remove lestipe a ill alee) 

remove last pet Laney) | 


from the lst arg, 
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then finds its length */ 


fails otherwise */ 


bombs) */ 


return as 2nd arg 


(list) 


y 


"d 


5d 
= 
"T 


^A 


T 
"A 


Somvert degr to rads(Angle in Deg,Angle in Rad) :- 


degr to rads factor (F), 
Angle in Rad is F*Angle in Deg, !. 


Bemvert rads to degrt(IZ,TZDeg) :- 


radsi eo degr factor(F2), 
TzZ0eq a3 KF2*T2, !. 


MOE to rads factor(F) :- F is 3.14159/180. 
Baemeoroegr factor(F) :- F is 160/3.14159. 


/* Succeeds if lst path includes 2nd path, fails otherwise. */ 
/* Assumes both arguments are bound. */ 

Inebdes patbh(P,P):- !. 

Enudes path([X1,Y1,c(C) IP1],P2) :- 


/* 


includes path(Fl, P2), !. 


Succeeds if arg 1 is a member of 2nd arg (a list), else fails */ 
member (X, [X|R]) :- !. 
member (X, (X2]R]) :- 


member (X, R), !. 


/* Succeeds if args 1 and 2 are members of 3rd arg (a list) */ 
in order listed, else fails */ 

member (X, Y, [X, YIR)])):- !. 

MEDEL (X, Y, [X2, Y2 (RJ) :<- 


/* 


member (X, YR), 1. 


/* Succeeds if args 1 thru 4 are members of Sth arg (a list) */ 
in order listed, else fails */ 

memoes (X1,¥1,%2, ¥2, (%¥1,Y1,X2,Y2Z21R1):- !. 

pember (X1, YU PXZ, Y2, [X3,Y3,X4,Y4I|R]) :- 


/* 


member (X1, ¥Y1,X2, Y2, [X4,Y4|R]), t. 


abs (A,A) :- A >= 0. 
ARSA,- -A) :- A<0. 


f NN hh ke e e he e hh ohh hh hh hh eh e e ehh he ehh ehh / 


7 
y ai 
/* 
/* 
/ * 
/ * 
E 
/* 
/ * 
/ * 
/* 
vt 


NOTE: For development purposes (until a pt-to-pt path planner is 
included in the program) optimal paths from each terrain feature 
vertex must be included in the mapdata file. Additionally, OP's 
from each shortcutting point along the opposite edge must be incl. 
There are two ways to query an optimal path: 


Y. 


2. 


Tenant iyo well get an OF from pt X,Y if such an OF 
exists in the database. 

opc A TP, 0) wath C unbound will get the OP from X,Y 
and determine the cost of the path. 

cat tE] will gel a “pseudo OP from X,Y af one 
pan lerpeS no Optimal path’; this 3s applicable to the 
first pass only. 


a 
a 
2 
yes 
i 
or 
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/* Computes the cost of an optimal path, given the path in the DB fay 
optimal path (bL,D) :- 
var (D), /* If opt path with total cost is already */ 
opbmalopath((L), /* asserted, use it (bgmapdata is consulted */ 
optimal path2(L,D), !. /* before bgutils), else compute it here. 
uunalspsbU ri c(C),x2,Y2],D1) :- TODI-CObDtiap3thahas»cost data, 
 distance(X1,Y1,X2,Y2,D), Dimes SG bl = this rule ag the base case 


opna a E C), X2, Y2 Rest], D) := /* If opt path has cost data 


a aa X2, Y2/Pest], D2), /* tbis rule as the rec. 
craneo 1,2, Y2,D1), Dla is C*D1, 
D is Piatb2, 1. 


or rtamal pari(L). ;-= 


7° 


Pseudo optimal path(L). 


SUCC e ct teis on line seqment he@iivBem pr2 6 pt3 inclusive * 


2m 


Cage 


i 


ond 


b 


on line (X1, Y1, XI re ee: 

on line(X2,;Y2,XI VI a s 

on Ce (XL, YU AS 
between(Xi,X1,X2), between(Yi,Y1,Y2), 
DelX is X2-Xl, DelY is Y2-Yl, not (between (DelX,0,0)), 
Yj is (Xi-X2)*DelY/DelX 4 Y2, 
within  Uolerance (ya 10x31 00] E 

on line(Xxi, Yi, X YI X a = 

E between(Xi,X1,X2), between(Yi,Y1,Y2), 

DelX is X2-X1, DelXi2 is X2-Xi, 
within tolerance (Velma, 11, Dele: . 


edge visibility check ((%a, Vax, Yb), (xan ie k AS 
CrossProdZ is (Xb-Xa)* (Yq-Ya)—(yb-Ya) * (Xg-Xa), 
CrossProdZ >= 0,!. /* True if AngleGAB is between 0 and pi, */ 
/* which is true if AB is visible from G.*/ 
edge visibility check ([Xa, Ya, Xb, Yb], [X919], (4ap 2a, ee 
edge_visibility check([Xxa3; Ya] Xb Yb|RListRes ggn 
[Xa, Ya, v|RevisedRListRest)) :- 
CrossProdZ is (Xb-Xa) * (Yq-Ya) —(Y¥b-Ya) * (Xq-xXa), 
CrossErodZ >= 0, /* True if AngleGAB is between 0 and pi, */ 
/* which is true if AB is visible from G.*/ 
edge visibility check ([Xb, Yb] RListRest (Xa, Ya, tev toca hed eee 
edge visibility check ((“%a Ya, xb YB (RESSERESTI, [2am E 
[Xa, Ya, h|RevisedRListRest])]) :- 
edge visibility check([Xb, Yb|RbEastRest), [Xq,Y¥q), RevisedRivatlese ae 


set done lag (bd bar /* Compute bdry until tte 55 
maxX (MaxX),minX (MinX), /* 6f££ the page by 1/2 the z 
maxY (MaxY) ,minY (MinY), /* width of the page, to  */ 
Xbdry » Minx- (1399 11nX) 725 /* account for rota sone e 


Xbdry < HaxX+ (MaxX-MinX)/2, 
Ybdry > Miny (Mari = Mn; 
Ybdry «Masrjiüaxycthnr)y2, 9 
sel done? f lag (bdr ect ae = /* if bdry is off the output page, */ 
assert (done),!. 1“ Set "done dn 


store 2vis resulta 12d O DON I ME 
Xg is Vx * Dg*cos(B), 
Xbaseline is Xq —- Yl*sin(Tl), 
Xbdry is Xbaseline - Y2*sin(T2), 
Ybdry is vy t Y2*cos(T2),; 
set done flag(Xbdry,Ybdry), 
retract (bdry (Blast)), 
assert (bdry (|[xXbdry, Ybdry|SBlist |) ) qs 


Zo 
* Output predicates. 
tud 


output Timi tandya 
te Pies Souk jy, 
nunber of edges(N), 
write to bdry file(number of edges,N), 
nl, IN 
ini bary 2R 
Wieder tor pdt fale (bury, A, tee 
fam 
output ont bday 
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Suepuc active bdrys :- 
beml(bdry out), nl, 
activebdry([H1,N2],B), 
uprcEtocburysfile(bdry,B,Wl,WN2), 
fail. 

Eubput active bdrys. 


/* 
NE U-putprolog facts to file "bdry out" 
"n 
Lema osbgry frle(t3tle,Title) :- 
cLcEIrlsgino write), !. 
EEESEStoSgbusy file(tstle,Title) :- 
write flag (Write), 
pernbebdry out), 
cele TO, write(Title), writet("*'").'), nl, !. 


pte to bdry file(goal, [X,Y]) :- 
cuextlsc(no write), !. 

mee to bdry file (goal, [X,Y]) :- 
wobcepi lag (write), 
telinbary out), 
Write ( goal (’), 
wrdtemex Yl, 
eitel je J; nl. 


ABE to bdry tile(number of edges,N) :- 
uo lagiino write), 1. 

ae to bdry fLile(number of edges,N) :- 
Poles ilag(write), 
Cenk tbary out), 
write (’number of edges(’), 
write(N), mo 
exutus). nl: 


pecstosbury file(opposite point,[X,Y,Xm,Ym,Xp,Yp]) :- 

mustemflagino write), t. 
poc-stosbpurvefile(opposste point, [X,Y,Xm,Ym,Xp,Yp]) :- 

wusvcerflagiwrite), 

Felitbdry sout) , 

vere (opposite point.(”), 

wiepee (some bee (>). write (Y), 

pare) nl, 

write('opposite point minus('), 

write(Xm), write(','), write(Ym), 

CDI ')-'nl, 

aaa opposite point plus('), 

unsxcctp  write(','), writetYp), 

mia). nl. 


Nro Cond mIIle(region,R) :- 
Nene lag (no write), !. 
write to bdry file (region, R) E 
Wereemtlag{Wwrite), 
teg BDdry out), 
en rcuon('), write(R), write(')-')., nl. 


Pee Omen ta le(reqion“elist,P.) :- 
write flag(no write), I7 
ete ea ile (region elist,R) = 
write flagiwgitle), 
termy out), 
write(' region _elist Oy, wriLte(P), HEM Cn]. 
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writecto bdry f)le 4p TE NIN?) =- 
write flag(no write), !. 
write tolbdry file(bar B UNZ) = 
write flag (write), 
tell (bey vow) 
write ( .bdry (a7 
write(IlHl.H2]j]owrate('."). 
write(B), 
write Js Ioni. 


write to lbdry till) 
= write flag(no write), a 
write to bdry file (bdry,B) :- 
|) write flag(write), 
tell(bdriy out), 
write('bdry('), 
write(B), 
writes tados 


pa 
* Output graphics instructions in “figure” formato tl eS 
Pa 
out put to tie EMS 
tellMbury Tetas 
write heading(bdry), 
bdry (BdryList), 
write to fig file(bdry Barre be 


write to fig rilet CE 
tell(bdriyifig); 
Litle(Text), 
assertz(subtitle('')), 
subtitle (Text2), 
agsertz (ideo est rele opo). /* Default width */ 
width of title(W), 
Indent is 4.25 - W/16, 
Write (dreavee 2) rts 
write (Indent),write(’ ’),write (10.3) ,write( "y vere DU 
write (Text),nl, 
write (drawtext),nl, 
write (Indent),write(’ *) write(9.9), write) erre ode 
write(Text 2) mio Y. 
write tò figur rio e 


write heading Cory mis 
tel T (Parera 
write(linestyle),n), witte (1) an 
write (linewidth),nl, write(0.01),nl. 


write headina eno 
Colima S 
write (limestyle), nil, weee (2) ni» 
write (linewidth) ,nl; “write 03) EE 


write EOUiieyeirle(hadry IRIS 
|^ —otell(bdry fig), 

draw emetic, 2) 

write to fsgafiletbdry, [x2, X 21S 
write to iam cd = 
write tọ fiq file(inv bary, [X1], Y1, X2 Ee ae 

tedptinedriq). 

dran IM 27a 
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aero ile bdry, [42,12 Rest]). 
Gece vO fig tule(inv bdry,_)- 


Pree CO tig filelgoal, [X,Y]) :- 
Bet (badry fig), 
scale coords (x,.,%1,¥1), 
write(linestyle),nl, write(1),nl, 
write(circle),nl, 
write(Xl),write(' '),write(Yl),write(' '),write(0),nl1, 
write(0.04),n1, !. 
aero file(inv goal, [X,¥]) :- 
tell(bdry fig), 
seale coords inv (X,Y Xi Yl), 
write(linestyle),nl, write(l),nl, 
write(circle),nl, 
utet wrrte(' ')^write(Yl),write(' '),write(0),nl, 
write(0.04),nl, !. 


Penco fig file(region, [X1,Y1[Rest]) :- 
eell{bdxy fig), 
rate rio Alle (restton, [21,Y1]Rest],Xend, Yend), 
drav line (X1, Yl, Xend, yend), ! . 
EEUcSro fig file2(region, [X,Y], X,Y). 
aeto fig tiylez (region, [X1,Y1,X2,YZ2[Rest],Xend, Yend) :- 
tell (bdry fig), 
draw lorie (X1|,Y1,X%2,¥<2)., 
i eommigena le? (reqron, |XZ2,¥Z|Rest),Xend,Yend), !. 
CO Liq fale(inv region, [M1,Y1,%2Z,Y¥Z|Rest]) :- 
tell(Ddry- fig), 
arae line Iny, Yl, X2; YA 
Wreleemuent iq filelinyv region x2, Y2| estl), v. 
Sto fig file(inv region, ). 


E Necoords(X,Y,X1,YY) :- /*- Scales and translates */ 
maxX (MazX),mazxzY(MaxY),minX(MinX),minY(MinY), /* coords to appropriate */. 
Ms l + (6.5*(X-Hii00 / (MaxX-MinX)), /* output coord system n 
Yl is (9*i(v-MinY)/(HMaxY-MinY)), '. 

lealemempanrds inv(X,Y,XxY,Y1) :- /* also reflects the ^ 
maxX (HMaxX),mazY(MazxY),minX(HMinX),minY(MinY), /* coords about the Kf 
A 11165 SM Ha A Min hi; /*mvertical line Be4.25 */ 


AAA Hari ins) ), UE 


pus ine, Yl,X2,Y2) :- 
scale tecortdos(x1,1l, A1b, 110), 
Scallemcoords (X2, 2, %2b,¥2b), 
wWewee(nolyline) ,ni, write (2),nl, 
wre) eeneenn), Write (8 ),write (Ylb),write(’ '),write(0),nl, 
rue b)write(' ') write (Y¥2b),writet’ "J, writei(0), nl, !. 
towelneri ny (40, ¥),%2,Y2) :- 
scale coords inv(X1,Y1,X1b,Y1b), 
Bcalcegecrrdscinv(X2,Y2,X9h,Y2b), 
wnubtesviine),nl, writest2),nl, 
Weve pe (* *).write(Ylb),write(' *'),write(0),nl, 
vaten Di write (’ ’),write(YZb),write(’ *) write(0),nl, !. 
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f Nh &h & k* k k hh hk À h hh hk kN h hh hU CO NCNONCRURUNUNDNU RN DNON RR ON OR RUN LUUD 
0000000000000 0000000000000 0I 000000 eoo eo 0000000000000 o A 
* 


* "bgmd22" 


* 

* File "bgmapdata" has terrain and goal data used by "bdrygen". 

* 

* o0 0o 0 0o à 0 00x A0 A Ax A 0 Àx& 0 Jn 0 Àx 0 0e oo x00 e 000x000 0000x000 000x000 0000 000000 


RARARARARRARRARARRAR RRR R 0 ROR 0 0 R0 e 0k AUU € € 0 A A RK / 


/* "region vertices" lists the vertices of one HCA 

* in clockwise order. First point listed can be any 
* of the vertices. 
t 

region vertaces0p45420290, 70,4071 602 20 2D LEID 


title("Example 22 ). 


goal porta 


/* " cost" is the time required to travel one unit of distance. 
* Note that this is the inverse of the "cost" used in 
* the “sls? coder 
Ray, 

interior costi JF 

exterior costi DE 


/* 
* "optimal path" is a temporary set oil predicates vhne nian- ny 

* the optimal path list from each vertex in the map. 

* Eventually, it will be replaced hy a rule which computes 

* the optimal path using a path-finding routine such as 

^ "sls Ver aaa 


optimal path([4,20,c(1),30,70,c(1),35,84]). 
optimal path 0 
optimal patie Gyape (1) 750, 307¢ (1), 3576 aie 
optimal path([60,30,c(1),35,84]). 
optimal path MS Ae 
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